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^^L1  near  optimal  control  laws  used  for  bank-to-turn  missile  guidance 
were  Investigated.  The  performance  of  these  control  laws  was  erratic 
because  their  development  neglected  attitude  dependent  constraints  on 
the  control  variables.  The  effects  of  an  Inequality  constraint  on  the 
control  variable  in  a  fixed  final  time,  zero  error  controller  were 
analyzed.  This  analysis  led  to  the  conclusion  that  the  accepted  tech¬ 
nique  of  applying  the  constraint  to  the  unconstrained  optimal  control 
solution  Is  valid  only  If  the  control  is  saturated  during  the  Initial 
portion  of  the  trajectory.  Constraints  during  the  terminal  phase  must 
be  anticipated  by  adjusting  Intermediate  boundary  conditions.  The 
nonzero  set  point  optimal  control  law  used  for  the  analysis  of  Inequal¬ 
ity  constraints  was  Incorporated  into  a  nonlinear  Bank-to-turn 
"attitude"  controller.  This  controller,  which  was  evaluated  on  a  six 
degree  of  freedom  simulation,  *,,'*ce  .ully  eliminated  the  deficiencies 
of  the  linear  controllers.  ^  sy 
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CHAPTER  I 
INTRODUCTION 

The  classical  approach  for  air-to-air  missile  control  was  based  on 
velocity  pursuit  guidance,  which  is  implemented  by  requiring  the  missile 
velocity  vector  to  point  at  the  target  [1].  While  adequate  for  slow 
moving  targets,  the  concept  fails  in  the  current  air-to-air  scenario 
because,  as  the  distance  to  the  target  decreases,  the  turning  rate  of 
the  missile  increases  until  unattainable  accelerations  may  be  required. 

Current  guidance  laws  are  based  on  proportional  navigation  which 
causes  the  missile  to  fly  a  straight  line  trajectory  toward  the  target 
[2,3,4].  In  proportional  navigation  (pro-nav),  the  line-of-sight  (LOS) 
rate  is  regulated  to  zero.  Consequently,  the  implementation  is  simple 
because  the  outputs  of  a  gimballed  seeker  provide  direct  missile 
acceleration  commands.  Also,  this  guidance  law  has  better  performance 
if  the  target  and  missile  have  constant  speeds.  Bryson  and  Ho  [5]  have 
shown  that  proportional  guidance  Is  optimal  in  the  linear  quadratic 
gausslan  (LQG)  sense  If: 

1.  the  target  has  constant  velocity, 

2.  the  missile  has  unlimited  and  Instantaneous  response, 

3.  the  LOS  angles  are  small, 

4.  the  missile  velocity  along  the  LOS  is  constant. 

However,  these  assumptions,  Inherent  In  the  formulation,  lead  to  rather 
serious  limitations  or  Inadequate  performance  In  the  current  air-to-air 
arena  [6].  Therefore,  Improved  missile  guidance  laws  are  required  for 
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more  demanding  engagements,  more  maneuverable  targets,  or  improved 
accuracy. 

While  a  number  of  guidance  laws  have  been  devised  to  improve  the 
shortcomings  of  pro-nav  [3, 4, 6, 7, 8, 9],  a  number  of  advanced  guidance 
techniques  have  been  investigated  to  increase  the  launch  envelope, 
provide  better  maneuver  capability,  and  reduce  the  miss  distance 
experienced  with  the  classical  approaches.  These  techniques  use  optimal 
control  methods  based  on  [1]: 

1.  Linear  Quadratic  Theory, 

2.  Linear  Quadratic  Gaussian  Theory, 

3.  Singular  Perturbation  Theory, 

4.  Reachable  Set  Theory, 

5.  Differential  Game  Theory, 

6.  Adaptive  Control, 

7.  Dual  Control, 

8.  Spline  Polynomial  Approximations. 

In  general,  these  studies  have  either  neglected  the  acceleration 
constraints,  uncoupled  the  equations  of  motion,  or  reduced  the  problem 
to  two  dimensions.  Nevertheless,  a  number  of  these  optimal  guidance 
laws  have  been  applied  to  the  study  of  a  specific  "generic"  short  range, 
highly  maneuverable,  bank-to-turn,  air-to-air  missile  [10,11]. 

For  the  models  under  consideration,  the  optimal  control  laws  were 
based  on  the  finite  dimensional  linear  system: 
x  =  Fx  +  Lu 

where  the  state  variables,  and  system  matrices  are  defined  to 
incorporate  assumed  system  dynamics.  The  control  laws  were  solved  in 
Inertial  coordinates  with  a  quadratic  cost  that  included  a  penalty  on 
miss  distance  and  assumed  a  known  fixed  final  time.  Four  linear  and 
four  nonlinear  laws  were  defined  by  Fiske  [8].  Table  1  presents  the 
description  of  the  linear  models. 
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TABLE  1.1  Optimal  Linear  Guidance  Laws 


DESIGNATION 


DESCRIPTION 


G1  Optimal  Linear  Guidance. 

G2  Optimal  Linear  Guidance  accounting  for 

target  acceleration. 

G3  Optimal  Linear  Guidance  accounting  for 

target  acceleration  and  first-order 
mi ssil e/autopilot  dynamics. 

G4  Optimal  Linear  Guidance  accounting  for 

target  acceleration  and  second-order 
missile/autopilot  dynamics. 


The  nonlinear  models  were  determined  from  the  same  models  as  the  linear 
guidance  laws  except  that  the  results  were  passed  through  the  saturation 
function. 

Initial  results  with  the  advanced  guidance  laws  indicated  only 
marginal  performance  gains  over  the  classical  technique,  pro-nav.  In 
fact,  proportional  guidance  performed  as  well  as  optimal  guidance  where 
the  missile  had  large  heading  errors  (in  violation  of  an  assumption  for 
pro-nav  optimality)  [5,8].  Also,  Increasing  the  complexity  of  the 
guidance  law  or  filter  (15  vs  9  states)  did  not  statistically  improve 
the  performance  [8]. 

As  a  simplifying  assumption,  the  optimal  control  derivations 
assumed  a  fixed  final  time.  And,  since  the  control  law  is  sensitive  to 
this  parameter,  an  Initial  explanation  for  the  failure  of  the  optimal 
guidance  laws  was  the  accuracy  of  the  Time-to-go  (Tgo)  estimate  [11]. 
Consequently,  an  Improved  Time-to-go  estimating  technique  was  developed 
by  Riggs  [12]  .  This  technique  was  simple,  stable,  and  effective  in 
increasing  the  missile's  performance  on  the  inner  launch  boundary.  The 
technique  also  addressed  one  of  the  other  less  desirable  assumptions  in 
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the  formulation  of  the  problem,  control  over  axial  acceleration.  In 
effect,  Riggs'  Tgo  algorithm  operates  by  equating  the  x  commanded 
acceleration  from  the  control  law  to  an  estimate  of  the  average 
acceleration  and  solves  the  unknown  parameter  Tgo.  With  this  new 
estimate  of  Tgo,  the  advanced  guidance  laws  (evaluated  with  a  passive 
seeker)  significantly  outperformed  pro-nav  in  the  short  range 
environment  [11]. 

This  thesis  addresses  some  remaining  limitations  of  the  current 
optimal  control  laws  and  provides  an  alternative  mechanization  of 
optimal  control  results. 


CHAPTER  II 

OPTIMAL  CONTROL  LAWS 


Modern  control  theory  [5,13,14]  provides  techniques  to  optimize 
guidance  laws  for  air-to-air  missiles.  With  respect  to  the  stochastic 
control  problem,  Shalom  and  Tse  [15]  outline  the  various  types  of 
stochastic  control  laws  available.  Shalom  and  Tse  and  Van  De  Water  and 
Willems  [16]  provide  justification  for  the  use  of  the  Certainty 
Equivalence  Property  (no  dual  effect  of  second  order).  Consequently, 
although  stochastic  models  are  discussed  in  [5]  and  a  specific  technique 
is  introduced  In  [8],  the  general  procedure  in  air-to-air  guidance  is 
the  use  of  filtered  estimates  that  provided  conditional  expectation  and 
rely  on  a  dynamlc-programmlng-like  definition  of  optimality  with  the 
Certainty  Equivalence  Property  to  find  optimal  control  laws 
[15,16,17].  Therefore,  the  guidance  laws  that  have  been  derived  and 
Implemented  in  [8,10,11]  and  that  will  be  considered  here  are 
deterministic. 

As  mentioned  previously,  the  studies  that  have  provided  optimal 
(both  linear  and  nonlinear)  guidance  laws  have  neglected  the 
acceleration  constraints,  uncoupled  the  equations  of  motion,  or  reduced 
the  problem  to  two  dimensions.  The  application  of  these  guidance  laws 
to  the  bank- to- turn,  air-to-air  missile  has  produced  unexpected  results 
[10,11].  Most  of  the  current  anomolies  can  be  traced  to  the  formulation 
of  the  control  law  and  the  properties  of  the  bank-to-turn  missile. 


While  this  vehicle  can  attain  high  normal  accelerations,  it  has 
some  unusual  limitations,  and  the  guidance  laws  did  not  consider  these 
restrictions.  To  begin  with,  the  control  laws  were  derived  using  an 
unconstrained,  fixed  final  time  controller  with  a  quadratic  penalty 
function  on  the  terminal  error  [7,8].  Actually,  the  problems  are  a 
terminal  controller  with  zero  terminal  error,  inequality  constraints  on 
the  admissible  controls,  and  final  time  free. 

Also,  there  is  an  aspect  of  this  generic  bank-to-turn  missile  that 
is  in  conflict  with  the  unconstrained  formulation  of  the  advance 
guidance  laws.  In  contrast  to  the  "standard"  air-to-air  missile  which  is 
symmetric  and  can  maneuver  equally  well  along  either  axis,  this  missile 
has  a  planar  body  that  provides  a  high  coefficient  of  lift.  (See 
Appendix  D.)  Consequently,  it  can  maneuver  well  along  one  axis  (100 
"g")  and  very  poorly  along  the  other  (5  "g"),  and  in  order  to  utilize 
it's  acceleration  potential,  the  missile  must  bank  to  maneuver  (turn). 
The  current  control  laws  function  with  relative  positions  and  velocities 
in  inertial  space.  Yet,  the  control  constraints  are  significantly 
different  for  each  body  axis  and  are  fixed  with  respect  to  the  missile 
body  axis.  The  result  is  unequal  control  constraints  that  are  a 
function  of  the  relative  target-missile  attitude  and  geometry. 

A  related  shortcoming  of  the  guidance  laws  is  the  absence  of  roll 
control.  This  absence  can  lead  to  additional  problems.  First,  the 
seeker  gimbals  are  limited  (60  degrees),  and  this  limitation  is  not 
considered.  Also,  since  the  guidance  laws  rely  on  the  autopilot  to  roll 
the  missile.  It  may  be  possible  for  an  evading  target  to  maneuver  itself 
such  that  Its  maximum  maneuver  direction  Is  orthogonal  to  the  missile's 
primary  axis  and  gain  a  temporary  maneuver  advantage.  Since  the  warhead 


effects  are  a  function  of  roll  angle,  these  effects  will  couple  with  the 
maneuver  advantage  to  limit  the  effectiveness  of  the  missile. 

The  first  shortcoming,  the  zero  error  controller  versus  the 
quadratic  penalty  on  the  miss  distance,  was  first  addressed  by 
Youngblood  [9].  In  [9],  the  following  assumptions  were  incorporated 
into  the  model: 

1.  PITCH  and  YAW  motion  are  uncoupled  by  roll; 

2.  the  angular  deviation  between  the  x  body  and  inertial 
axes  is  always  equal  to  zero; 

3.  the  relative  axes  are  nonrotating  and  the  line  of  sight 
angl e  i s  smal 1 ; 

4.  the  target  has  constant  lateral  acceleration. 

While  the  research  effectively  handled  the  zero  terminal  error 
aspect  and  demonstrated  improved  performance,  it  did  not  consider  the 
control  constraints  or  the  fact  that  the  Euler  angles,  and  consequently 
the  control  law,  were  changing  as  a  result  of  the  control  Inputs. 

An  analysis  of  the  trajectories,  in  addition  to  the  miss  distance, 
indicated  that  the  primary  problem  with  the  control  laws  using  the 
Improved  Tgo  was  associated  with  the  attitude  dependent  missile 
acceleration  constraints  that  were  not  modeled.  Consider  for  example 
the  following  two  runs  made  from  the  same  initial  conditions  using 
different  guidance  laws.  Both  of  these  runs  are  well  within  the  launch 
envelope  of  the  guidance  law,  use  perfect  position  data  with  control 
Inputs  that  are  constrained  by  the  autopilot,  and  are  against  a  target 
that  begins  a  level  9  "g"  turn  when  the  range  equals  6000  feet.  Run  1 
uses  Gl,  and  Run  2  uses  G4— the  more  sophisticated  guidance  law. 
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Figure  2.1  A  G1  CONTROLLED  INTEP.CEPT  EXAMPLE-POSITION 
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As  seen  from  Figures  2.1  and  2.2,  the  simpler  G1  performs  better 
than  G4  In  that  it  has  a  smaller  miss  distance  (21  versus  32  feet)  and 
more  control  available  in  the  terminal  phase.  The  difference  is  caused 
by  the  fact  that  G4  incorporates  second  order  missile  dynamics  and 
generates  a  command  that  accounts  for  the  imperfect  autopilot. 
Consequently,  terminal  errors  in  the  states  cause  higher  acceleration 
commands  as  G4  accounts  for  autopilot  delays.  These  commands  saturate 
unequally  and  the  resultant  vector  is  rotated  away  from  the  target. 
This  in  turn  causes  larger  deviations,  further  saturation  and  a  near 
miss.  In  fact,  while  the  acceleration  commands  of  G1  are  well  within 
the  maximum  since  the  missile  performed  the  roll  toward  the  target,  the 
G4  commands  are  saturated  for  the  last  .36  seconds  prior  to  impact. 

An  attempt  to  include  control  constraints  resulted  in  the  nonlinear 
models  of  Fiske  [8].  But  these  nonlinear  models  were  determined  from 
the  same  models  as  the  linear  guidance  laws  except  that  the  results  were 
passed  through  a  saturation  function.  This  method  had  two  errors. 
First,  the  Inertial  constraints  are  Euler  angle  (attitude)  dependent, 
and  as  seen  from  Figures  2.1  and  2.2,  arbitrarily  limiting  one  or  both 
axes  without  considering  the  effect  on  the  resultant  acceleration 
command,  can  cause  the  missile  to  actually  accelerate  away  from  the 
target.  Second,  while  the  use  of  the  saturation  function  seems  like  the 
natural  procedure  and  Is  discussed  by  Tufts  and  Schnldman  [18]  and 
Bryson  and  Ho  [5],  the  unmodified  use  of  the  saturation  function  may  not 
be  optimal.  A  discussion  of  the  effects  of  constraints  on  control 
continues  in  Chapter  III. 


If  the  model  used  to  develop  the  controller  accurately  describes 
the  dynamical  system  and  a  closed  form  solution  for  this  model  can  be 
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computed,  then  the  optimal  control  can  be  based  on  initial  solution  of 
the  unique  two  point  boundary  value  problem.  Consider  two  identical 
systems.  If  one  of  the  processes  is  "interrupted"  and  then  reinitiated 
using  the  existing  values  as  initial  conditions  to  the  same  boundary 
value  problem,  then  two  processes  would  still  have  the  same 
trajectory.  However,  if  the  model  used  to  develop  the  controllers  was 
not  accurate  because  of  approximation,  neglected  states,  etc.,  then  the 
same  experiment  with  the  "simplified"  controller  would  not  produce  the 
same  trajectory,  and  the  interrupted  controller  would  have  feedback 
gains  that  are  more  consistent  with  the  accurate  controller. 
Consequently,  the  "simplified"  controller  must  be  reinitialized  at  each 
guidance  update  [6].  In  the  latter  case,  the  terminal  controller  is  not 
a  function  of  time  but  of  only  Time-to-go  to  the  terminal  state.  This 
is  an  effective  technique  to  accomodate  nonlinearities,  modeling  errors, 
and  uncertain  target  maneuvers. 

In  addition,  the  one  step  update  gives  the  terminal  controller  with 
a  quadratic  penalty  function  on  the  terminal  error  some  of  the 
properties  of  the  zero  terminal  error  controller.  In  the  quadratic 
penalty  error  controller,  the  control  gains  decrease  to  zero  as  the  time 
approaches  the  final  time.  In  the  zero  terminal  error  controller,  the 
control  gains  grow  without  bound  as  Tgo  approaches  zero.  When  a  one 
step  update  Is  used  with  the  quadratic  penalty  error  controller,  the 
small  Time-to-go  couples  with  terminal  errors  resulting  from  the 
simplified  model  to  produce  acceleration  commands  that  grow 
exponentially.  Figure  2.3  depicts  the  acceleration  commands  from  the 
guidance  law  Gl,  as  a  function  of  Time-to-go,  for  the  same  rang'  and 
velocity.  As  Tgo  becomes  small,  the  acceleration  commands  grow 
exponentially,  resembling  the  zero  terminal  error  controller. 


CHAPTER  III 
CONSTRAINED  CONTROL 


In  a  missile  guidance  and  control  system,  the  function  of  the 
autopilot  is  to  realize  the  commanded  acceleration.  When  the 

acceleration  is  not  realizable  because  of  aerodynamic  or  structural 
limitations,  the  autopilot  generates  the  maximum  allowed  for  each 
axis.  In  effect,  the  autopilot  saturates  each  axis  of  the  commanded 
acceleration  independently  and  may  significantly  modify  the  resultant 
vector.  Therefore,  when  these  control  constraints  are  introduced,  the 
optimal  control  law  discussed  In  the  last  chapter  Is  no  longer  valid. 

The  optimal  control  law,  given  by  Pontryagin's  Maximum  principle 
for  a  linear  system  with  a  quadratic  performance  index,  is  found  by 
maximization  of  the  Hamiltonian  which  is  a  quadratic  function  of  the 
state,  control  and  adjoint  variables  [5,18].  In  the  absence  of 
constraints,  this  leads  to  a  linear  control  law.  With  constraints,  the 
form  of  the  control  law  Is  still  linear  provided  the  constraint  is  not 
violated.  Otherwise,  the  control  is  equal  to  the  constraint.  Due  to 
the  form  of  the  constrained  optimal  control,  one  might  assume  that  the 
constrained  control  can  be  obtained  by  direct  application  of  the 
constraints  to  the  unconstrained  optimal  control  [5].  This  technique, 
while  simple  to  implement,  may  not  be  optimal,  and  often  will  not  allow 
the  terminal  condition  to  be  met. 

In  this  chapter,  the  relationship  between  the  constrained  optimal 
control  and  the  suboptimal  control  formed  by  constraining  the 
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unconstrained  optimal  control  will  be  discussed.  It  is  shown  that  in 
certain  situations  (initially  constrained  control),  when  feedback 
controls  are  implemented,  the  two  cases  are  identical.  If  the  final 
portion  of  the  trajectory  is  on  the  constraint,  however,  the  system  will 
not  be  able  to  satisfy  the  terminal  boundary  conditions  unless  the  final 
condition  is  in  the  reachable  set  of  the  constrained  control. 
Therefore,  the  initial  (unconstrained)  segment  of  the  trajectory  should 
be  adjusted  to  account  for  the  final  constraint. 

Because  uncertainty  with  respect  to  the  final  state  is  assumed 
(which  will  also  account  for  unmodeled  errors  in  the  dynamical  system), 
a  one-step  update  will  be  used. 

Consider  the  state  variable  of  the  first  order  example  and  the  form 
of  the  quadratic  cost.  The  common  technique  in  air-to-air  guidance  is 
to  select  relative  Euclidian  coordinates  as  the  state,  and  control  to  a 
zero  set  point.  This  establishes  the  value  of  the  state  variable  as  the 
difference  between  the  missile  and  target  inertial  positions.  And 
consequently,  the  boundary  condition  for  the  relative  state  is  always 
zero.  Another  technique  better  suited  to  solving  this  optimal  control 
problem  with  inequality  constraints  on  the  control  is  to  choose  the 
seeker  gimbal  angles  as  the  states,  use  the  linear  control  law  to 
determine  the  optimum  angles,  allow  a  non-zero  set  point,  and  solve  the 
differential  system  to  include  the  actual  boundary  conditions.  Also, 
the  usual  quadratic  cost  penalizes  the  deviation  from  the  final  state. 
In  this  case,  however,  the  intermediate  cost  is  in  large  gimbal 
angles.  First  the  gimbal  angles  are  structurally  limited.  This  is,  in 
fact,  a  state  variable  constraint  which  is  not  modeled  in  the 
optimization.  A  larger  angle  increases  the  probability  of  exceeding  the 


gimbal  angles  limit  when  the  target  maneuvers.  Second,  because  the 
missile  has  two  to  three  times  the  velocity  of  the  target,  larger  gimbal 
angles  will  lead  to  higher  accelerations  during  the  terminal  phase  if 
there  are  errors  in  the  estimate  of  the  optimal  angle  due  to  an  input 
parameter  such  as  relative  position,  velocity,  acceleration,  or  Tgo. 


Constrained  Control  Solution 


Given:  x(tQ),  y(tQ)  with  x(tf)  =  y(tf) 
Determine  the  optimum  control  such  that: 


2  2 

J  =  /  (x  +  u  )  dt  is  minimum 


subject  to  the  constraints  lu(t)|  <  a  and  x(tl 


Writing  the  Hamiltonian 


H  =  x2  +  u2  +  P'u 


The  adjoint  is  given  by  the  solution  of 


P  =  -Hx  .  -2* 


and  the  u  which  minimizes  H  is  found  to  be: 


-a  sgn  (P) 


-V9P 


|P|  >  2a 


|P|  <  2a 


Consider  first  the  times  when  the  control  is  unconstrained,  then 


H„  '  0  «  -  -  i 


+  X  =  X 


And,  if  T  :=  tf  -  tg 


y(tf) 

X(t)  =  { -j — Lj 

e  -  e 


x(t0)e"T  (t-tQ) 


TTT^ 


}  e 


x(tQ)eT  y(tf)  -(t-tQ) 

+  {  7 — 7T  “  7 — J e 

e  -  e  e 


and 


-T 


y(tf)  x(tn)e“‘  -(t-tn) 

u(  t)  a  {  t - - rle  ° 

e  -  e  e  -  e 


x(tQ)eT  y(tf)  i  -(t-t0) 

’  *  7  pr  ”  j  pr } e 

e  -  e  e  -  e 


Now,  let  t  *  tg  -*•  current  time.  Therefore, 

co$h{  tf  -  tg)  y(tf) 

x{t0)  =  u(t0)  =  -  ^TnH{  tf  -  tg>  x{  V  +  sfnh{  tf  - 


V 


which  can  be  made  exact  by  an  Integrating  factor  and  integrated 
directly.  The  result  is  a  closed  form  expression  for  x  at  any  time: 
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Initial  Constraints 

Assume  that  the  control  will  be  on  the  constraint  during  the 
initial  portion  of  the  trajectory.  In  this  case,  the  saturated  value  is 
the  optimal  control.  It  is  possible  to  calculate  the  time  that  the 
control  will  first  become  unconstrained.  While  the  control  law  must 
consider  the  sign  of  the  state  and  control,  for  clarity,  the  following 
equations  assume  a  positive  state,  and  therefore,  a  negative  control. 

While  on  the  constraint,  the  state  will  follow: 

x(t)  3  x(tQ)  -  at 

Setting  the  expression  for  the  control  equal  to  "-a"  and  solving  for  "t" 
will  provide  a  transcendental  equation  that  gives  the  switching  time 
from  constrained  to  unconstrained  control: 

-(tf-tj 

2y(tf)  -  e  s  {  a  +  x(tQ)  -  a(tf  -  ts)  } 

-{  tf-t  ) 

-e  {  x(tQ)  -  a  -a(tf-t$)  }  =  0 

Here  "to"  Is  equal  to  the  initial  time,  "tf"  the  final  time,  and  "ts" 
the  switching  time. 

Final  Constraints 

If  the  value  of  the  optimal  control  Is  larger  than  the  constraint 
during  the  final  portion  of  the  trajectory  and  the  control  law  does  not 
anticipate  this  fact,  the  boundary  conditions  will  not  be  met.  However, 
there  may  exist  a  Time-to-go  and  state  such  that  the  subsequent  use  of 
the  saturated  control  will  cause  the  system  state  to  just  satisfy 


JL 


boundary  conditions.  If  the  control  is  equal  to  the  saturated  value  "a" 
and  the  state  is  equal  to: 


x(t$)  =  y(tf)  -  a(tf-t$), 

then  the  terminal  boundary  conditions  will  be  met. 

Because  the  closed  loop  control  Is  not  defined  at  t  =  t^,  and  the 
control  law  only  provides  the  fact  that 
x  =  u 

the  open  loop  control  expression  must  be  used  to  determine  this  time. 
Solving  for  time  In  the  open  loop  equation  with: 
y(ts)  -  y(tf)  -  a(tf-ts) 
u(t$)  =  a 

% 

T  "  ts  -  tQ 


y(t  ) 

u(t)  3  {  T 


x(tQ)e 
e^  -  e 


-T 


^  e 


fts-t0i 


x(tn)e 

-  ( 

e  -  e 


»(tS>  ,  /'W 

T  •  e 


eT  -  e 


The  result  Is  the  following  equation  for  t$: 

a  s1nh{ts-tQ>  -  {  y(tf)  -  a(tf-t$)  }  cosh{t$-t0}  +  x(tQ)  =  0 
This  equation  can  be  solved  for  the  associated  switching  time.  Then, 
this  time  "ts",  and  boundary  condition— 
x(t$)  3  y(tf)  -  a(tf-t$) 

are  used  In  the  solution  of  an  unconstrained  optimal  control  problem. 
The  result  will  be  a  control  that  meets  the  actual  boundary  condition 
"y(tf)M  at  *tf\ 


Examples 


The  following  figures  Illustrate  the  use  of  the  computed  switching 
times  to  account  for  boundary  conditions.  In  these  first  order 
examples,  the  initial  value  of  the  state  Is  1,  the  initial  boundary 
condition  is  the  zero  state,  and  the  control  is  constrained  to  a  value 
of  1.1.  If  the  terminal  boundary  condition  changes,  it  does  so  at  .5 
seconds  and  is  set  again  at  1.  Also,  in  these  examples,  the  following 
definitions  are  used: 

Unconstrained  =  There  are  no  contraints  on  the  control  magnitudes. 

Suboptima 1  3  There  are  constraints  on  control  magnitudes,  but  an 

unconstrained  control  is  calculated  and  passed 
through  the  saturation  function. 

Constrained  =  There  are  constraints  on  control  magnitudes,  and 

the  control  is  calculated  to  account  for  the  con¬ 
straint. 

Reachable  Set  =  There  are  constraints  on  control  magnitudes,  and 

the  control  is  calculated  to  ensure  that  the  final 


control  is  off  of  the  constraint. 


i  .20E+00  .40E+00  .60 £+00  .30E+00  .10E+01 

Time  (seconds) 

Final  State  Value  *  0 

Figure  3.1  UNCONSTRAINED  CONTROL— SINGLE  FINAL  CONDITION 

In  Figure  3.1,  the  unconstrained  control  and  state  values 
are  presented.  There  is  only  one  final  condition. 


M  .20E+00  .40E+00  .(50E+00  .30E+00 

Time  (seconds) 

Final  State  Value  =  0 
Figure  3,2  SUBOPTIMAL  CONTROL— SINGLE  FINAL  CONDITION 

Fiaure  3.2  shows  the  effect  of  an  initial  constraint. 


00  .20E+00  .40E+00  .60E+00  .80E+00  .10E+01 

Time  (seconds) 

Final  State  Value  =  1. 

Figure  3.3  UNCONSTRAINED  CONTROL— MULTIPLE  FINAL  CONDITIONS 

Figure  3.3  shows  the  system  behavior  when  the  terminal 
condition  is  changed  at  t  *  .5.  Again,  there  are  no  con¬ 
straints  on  the  control. 
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0.00  .20E+00  .40E+00  .60  E+00  .30E+00  .10E+01 


Time  (seconds) 
Final  State  Value  =  .975 


Figure  3.4  SUBOPTIMAL  CONTROL-MULTIPLE  FINAL  CONDITIONS 


In  Figure  3.4,  the  effect  of  the  unanticipated  final 
constraint  is  illustrated.  In  this  case,  the  final  boundary 
condition  is  not  met. 


I 


- J  Control  ljimit 

00  .20E*00  .40E*00  .60  E*00  .S0E-00 

Time  (seconds) 

Final  State  Value  =  1.0 

Figure  3.5  CONSTRAINED  CONTROL— MULTIPLE  FINAL  CONDITIONS 
Figure  3.5  shows  the  proper  handling  of  the  final 


constraint.  In  this  case,  the  unconstrained  terminal 
conditions  are  adjusted  so  that  the  final  condition  is 
met  with  the  saturated  control. 


While  the  constrained  control  in  Figure  3.5  does  meet  the  boundary 
conditions,  the  terminal  condition  is  on  the  boundary  of  the  reachable 
set.  Any  additional  change  after  the  control  is  saturated  (in  the 
direction  away  from  the  origin)  cannot  be  controlled  by  the  input.  If 
the  control  is  going  to  saturate  during  the  final  phase,  another 
technique  is  shown  in  Figure  3.6.  Here  the  control  is  placed  on  the 
constraint  until  the  switching  time  when  unconstrained  control  is 
allowed.  This  procedure  will  ensure  that  the  control  is  in  the  linear 
region  for  the  terminal  portion  of  the  intercept  and  is  a  partial 
alternative  to  the  reachable  state  control  algorithm  presented  in  [6], 


Summary 


In  summary,  to  optimally  handle  constraints  two  cases  must  be 
considered.  In  the  first  case,  a  saturated  control  unsaturates  prior  to 
the  final  time.  Here,  the  use  of  the  saturation  function  is  the  proper 
control.  In  the  other  case,  however,  the  control  is  such  that  it 
saturates  during  the  terminal  stages  of  the  intercept.  Now,  the  fact 
that  the  control  Is  going  to  saturate  must  be  considered.  In  the  case 
of  the  first  order  trajectory,  this  is  handled  by  changing  the  final 
time  and  boundary  condition  of  the  unconstrained  portion  of  the 
control.  Reversing  the  time  that  the  saturated  and  unconstrained 
control  is  applied  ensures  that  the  target  remains  well  within  the 
reachable  set  of  the  missile  control. 


)0  .20E+00  .40E+00  .60E+00  .S0E+00  .10E 

Time  (seconds) 

Final  Value  *  1.0 


Figure  3.6  REACHABLE  SET  CONTROL 


CHAPTER  IV 

NONLINEAR  CONTROL  LAW 


Numerous  attempts  were  made  to  incorporate  the  attitude  dependence 
of  the  engagement  in  a  state  space  model  by  including  the  Euler  angles 
in  the  model  formulation  and  exploiting  the  properties  of  the  bank-to- 
turn  missile.  If  these  angles  could  be  included,  the  control  laws  would 
be  optimal  in  the  dynamic-programming  sense  because  the  same  optimal 
control  laws  would  be  used  in  the  future  [17].  Considering  that  the 
control  inputs  cause  the  change  in  the  inertial  and  relative  attitudes 
and  that  the  Euler  angles  describing  the  missile  attitude  and  the  seeker 
angles  describing  the  relative  angular  differences  can  be  large,  the 
system  matrices  are  time  and  control  dependent.  Consequently,  the  model 
is  nonstationary  and  the  limiting  solution  of  the  algebraic  Riccati 
equation  is  not  appropriate.  Working  directly  with  the  Euler-Lagrange 
equations,  approximate  methods  such  as  singular  perturbations  and  the 
method  of  averaging  were  attempted  [19,20,21].  But  even  with  approxi¬ 
mations,  the  result  was  a  coupled  set  of  nonlinear  equations,  and  the 
major  value  of  the  approximation  methods  was  lost  [22].  Consequently, 
each  effort  was  terminated  when  the  assumptions  and/or  approximations 
required  for  a  closed  form  solution  invalidated  the  purpose  of 
incorporating  the  Increased  complexity.  The  only  result  of  these 
tedious  exercises  was  the  author's  agreement  with  Gupta  et  al.  [6]: 
"When  the  detailed  translational  and  rotational  missile  model  is  used, 
the  resulting  TPBVP  [Two  Point  Boundary  Value  Problem]  is  so  complex 


that  it  cannot  be  solved  in  real  time  even  with  the  most  advanced 
digital  hardware". 

Instead,  since  the  major  problem  with  the  current  guidance  laws  was 
the  unmodeled  constraints,  a  scheme  was  developed  that  would  incorporate 
the  optimal  guidance  laws  and  still  apply  the  acceleration  commands 
consistent  with  the  control  constraints. 

Guidance  Law 

The  seeker  gimbal  angles  provide  a  direct  indication  of  the  target- 
missile  geometry.  Using  the  seeker-to-missile  body  transformation 
outlined  in  Appendix  B  and  the  dynamics  approximations  presented  in 
Appendix  C,  the  following  relationships  can  be  derived: 

ujy  *  -p  sin  <j,g  -  (Nz/u)  cos  4, 

o)z  s  p  sin  eg  cos  <(,g  -  (Nz/u)  sin  eg  sin  <|>g  +  (Ny/u)  cos  eg 

where  *  missile  rotation  about  the  seeker  y  axis 

u2  *  missile  rotation  about  the  seeker  z  axis 
9g  *  seeker  elevation  angle 
<j»g  *  seeker  azimuth  angle 
Ny  *  acceleration  along  the  y  body  axis 
Nz  *  acceleration  along  the  z  body  axis 
u  “missile  velocity  along  the  x  body  axis 
p  *  missile  roll  rate  about  the  x  body  axis 

These  equations  provide  a  method  of  generating  the  linear  accelerations 
to  control  the  missile's  relative  attitude  by  controlling  the  gimbal 
angles  since  the  change  in  the  seeker  angles  due  to  missile  attitude  is 


<Dy  and  o)z.  A  positive  rotation  about  either  axis  causes  a  negative 
change  in  the  seeker  angle.  Therefore: 

9g  *  -wy  =  +P  Sin  d,  +  (Nz/u)  cos  4, 

<Pg  =  -uz  ■  -p  sin  eg  cos  <j,g  +  (Nz/u)  sin  eg  sin  <p  -  (Ny/u)  cos  eg 

Consequently,  an  "attitude  controller"  can  be  developed  using  the 

first  order  control  laws  from  Chapter  III  and  steering  from  the  advanced 
guidance  laws.  The  inertial  controls  are  used  to  generate  the  "optimal" 
trajectory  (not  accounting  for  constraints).  Then  these  relative 
directions  are  rotated  to  the  missile  body  axis  and  compared  to  the 
existing  seeker  angles  to  determine  the  optimal  seeker  angles.  These 
optimal  angles  are  used  as  boundary  conditions  for  a  constrained  control 
law  that  relates  the  angles  to  the  control  inputs. 


Longitudinal  Control 

Setting  the  state  equal  to  the  seeker  angle  eg,  the  control  input 


to  9  ,  and  considering  only  longitudinal  motion  (p  =  N  =  0)  the 


relationship  leads  to  the  following  control: 

29. 


(eT  +  e"T)9, 


yr 


opt 


e  -  e 


i  _ |L 

cos 


where  eopt  *  the  9g  derived  from  the  linear  control  law. 


Lateral -Directional  Control 

N  .  Setting  the  state  equal  to  the  seeker  angle  the  control 
J.  * 

input  to  <£g,  and  solving  for  Ny  with  p  and  Nz  equal  to  zero: 


(eT  +  e‘TU  2d.  * 
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ROLL.  While  the  gimbal  angle  4^  is  controlled  by  the  Ny 
acceleration,  the  magnitude  of  this  control  is  severely  limited. 
Therefore,  to  handle  this  constraint,  the  control  law  must  be  expanded 
to  position  the  missile  such  that  the  Nz  acceleration  can  be  used  to 
achieve  the  intercept.  Since  the  gimbal  angle  4>g  is  equal  to  the  roll 
angle  difference  between  the  maximum  maneuver  plane  of  the  missile  and 
the  relative  target  position,  the  azimuth  angle  can  be  used  in  place  of 
the  roll  angle  difference  to  generate  the  roll  rate  command.  Once  the 
roll  rate  command  is  incorporated,  however,  the  approximation  used  in 
the  Ny  equation  is  not  always  valid.  When  there  is  a  large  roll  angle 
difference,  p  will  be  the  dominant  control  with  a  small  contribution 
from  Ny  (which  will  also  help  control  adverse  yaw  on  a  higher  order 
system).  As  the  roll  angle  difference  approaches  zero,  the  roll  rate 
will  decrease  while  Ny  continues  to  control  the  gimbal  angle  cj,g  during 
the  terminal  phase. 


p  =  +  { 


(eT  +  e"T)  4, 


a . 


2 


dpt 


Time-to-Go 

Even  though  Rigg's  algorithm  improved  the  performance  of  the 
advanced  guidance  laws,  it  continued  to  underestimate  the  time-to-go 
during  the  initial  segment  of  the  trajectory.  This  is  because  the 
algorithm  neglected  the  attitude  of  the  missile  when  setting  the  X 
inertial  acceleration  to  the  actual  acceleration  (x  body  axis)  of  the 
missile.  Rigg's  algorithm  is  repeated  here: 


Tgo 


_ 2R 

Vc  +  SQRT(Vc^  4AR) 
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where  Tgo  =  time-to-go 

Tb  =  time  during  which  the  missile  is  accelerating 

t  =  time 

R  =  range 

Vc  =  closing  velocity 

A  =  average  acceleration 

Amax  =  acceleration  during  boost 

Ardn  *  deceleration  after  burnout 

As  shown  by  Lee  [23],  the  actual  time-to-go  is  a  function  of  the 
trajectory  (including  constraints).  While  the  constraints  cannot  be 
easily  handled,  the  difference  between  the  inertial  and  body  axis 
accelerations  can  be  corrected  by  considering  the  angular  differences. 

As  seen  from  the  Tgo  formula,  in  addition  to  the  estimate  of 
missile  acceleration,  the  closing  velocity  (Vc)  Is  used.  This  term  is 
substituted  for  the  X  component  of  relative  velocity  In  the 
derivation.  Vc,  however.  Is  along  a  vector  from  the  missile  to  the 
target  and  not  in  the  X  direction.  If  the  Euler  angles  that  describe 
the  missile's  orientation  are  included  In  resolving  the  difference 
between  the  X  acceleration  command  and  the  missile  orientation,  the 
result  Is  a  cubic  equation  containing  the  direction  cosines.  Inertial 
positions,  velocities,  and  accelerations. 

A  simpler  technique  is  to  correct  the  closing  velocity,  and  resolve 
the  component  in  the  x  missile  direction.  This  is  accomplished  by 
calculating  the  spherical  angle  (Aoff)  between  the  missile  x  axis  and 
target  and  then  using  the  x  component  of  the  closing  velocity  in  the 
computation  of  the  x  commanded  acceleration. 
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Aoff  =  tan 


I  ✓  (z1 2  +  y2)  | 


A  =  A  cos  (Aoff) 


where  x  =  relative  x  distance  to  the  target  in  the  body  axis  frame, 

y  =  relative  y  distance  to  the  target  in  the  body  axis  frame, 

z  3  relative  z  distance  to  the  target  in  the  body  axis  frame. 

Another  minor  correction  was  made  to  the  Tgo  algorithm  by 

correcting  the  estimate  of  average  acceleration  which  is  A  above.  The 
algorithm  calculates  this  value  and  then,  if  the  time  is  greater  than 
the  motor  burn  time,  the  acceleration  estimate  is  set  to  Amin.  However, 
If  the  time-to-go  Is  less  than  the  missile  burn  time,  then  the  second 
component,  the  deceleration  term,  is  added  to  the  acceleration  term  in 
the  computation  of  average  acceleration. 

A  better  acceleration  estimate  is  calculated  if  all  three  cases  are 
considered  separately: 

1.  intercept  during  the  boost  phase,  time  less  than  Tb; 

Amax  (TK  -  t) 

•  b 

- - Tgo - 

2.  Intercept  during  the  coast  phase,  time  less  than  Tb; 

Amax(Tb  -  t)  +  Am1n(Tgo  +  t  -  Tb) 

- - Tgo - 

3.  current  time  greater  than  accereration  time; 


A  *  Amin 


CHAPTER  V 
RESULTS 


Four  topics  have  been  discussed  with  respect  to  the  control  of  the 
bank-to-turn  missile.  These  are  the  effect  of  constraints  on  control, 
the  linear  optimal  control  laws,  the  Improvement  of  the  Time-to-go 
estimate,  and  a  nonlinear  control  law.  The  results  of  additional 
evaluations,  the  modifications  Incorporated,  and  the  nonlinear  control 
law  will  be  presented  here. 

Constrained  Control 

The  four  trajectories  used  to  evaluate  the  effect  of  constraints 
are  shown  In  Table  5.1: 

Table  5.1  Boundary  Conditions 


Initial 

Trajectory  Conditions 


Terminal  Condition 
Time  Value 
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Table  5.2  presents  the  cost  for  each  of  the  trajectories.  Here  the 
same  terminology  is  used  that  was  introduced  in  Chapter  III.  As  seen 
from  the  table,  the  optimal  control  is  the  minimum  cost  solution  that 
meets  the  final  value  when  used  with  the  trajectories  that  have  a  single 
boundary  condition  (trajectories  1  and  2).  Also  as  expected,  a  control 
constraint  Increases  the  cost,  even  if  it  is  handled  in  an  optimal 
fashion,  if  there  is  no  change  in  the  terminal  boundary  condition. 


Table  5.2  Cost  Function 


Trajectory 

Control 

Cost 

Final  Condition 

1 

Unconstrained 

1.323 

Yes 

Suboptimal 

1.325 

Yes 

Constrained 

1.325 

Yes 

Reachable  Set 

1.325 

Yes 

2 

Unconstrained 

1.303 

Yes 

Suboptimal 

1.243 

No 

Constrained 

1.311 

Yes 

Reachable  Set 

1.392 

Yes 

3 

Unconstrained 

1.740 

Yes 

Suboptimal 

1.654 

No 

Constrained 

1.718 

Yes 

Reachable  Set 

1.722 

Yes 

4 

Unconstrained 

.816 

Yes 

Suboptimal 

.816 

Yes 

Constrai ned 

.917 

Yes 

Reachable  Set 

1.312 

Yes 

The  trajectories  with  changing  terminal  conditions,  where  the 
constraint  is  never  violated,  however,  display  some  unexpected 
properties  and  have  been  included  as  Figures  5.1  through  5.3.  First, 
the  optimal  control  may  not  lead  to  the  lowest  cost.  If  the  control 
expects  to  be  on  the  constraint  during  the  final  portion  of  the 
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Figure  5.1  UNCONSTRAINED  CONTROL 
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Figure  5.2  SUBOPTIMAL  CONTROL— WITH  UNREALIZED  CONSTRAINTS 
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Figure  5.3  CONSTRAINED  CONTROL— WITH  UNREALIZED  CONSTRAINTS 
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trajectory,  it  increases  the  control  during  the  initial  phase  to  insure 
that  the  final  condition  is  met.  If  the  final  condition  is  changed, 
then  the  increased  control  may  not  have  been  required.  In  fact,  the 
increased  control  can  result  in  a  larger  displacement  from  the  new 
terminal  condition.  The  result  is  an  overall  higher  cost  for  the 
complete  trajectory. 

Second,  with  a  discontinuous  boundary  condition,  the  constraint  may 
not  lead  to  an  increase  in  cost.  Again,  this  is  a  function  of  the 
initial  conditions  and  the  change  in  the  final  condition.  The 
explanation  for  this  effect  is  similar  to  the  first  in  that  the 
constraint  may  keep  the  state  closer  to  the  second  terminal  condition. 

While  these  are  interesting  observations,  it  should  be  noted  that 
the  changes  in  the  terminal  boundary  condition  are  quite  severe  and  that 
these  effects  are  dependent  on  the  changes  and  when  they  occur.  Also, 
if  the  boundary  condition  is  within  the  reachable  set,  the  only  control 
that  can  always  meet  the  condition  is  the  properly  formulated  optimal 
control . 


Linear  Optimal  Control 

Generally,  the  performance  of  a  guidance  law  for  air-to-air 
missiles  is  measured  by  the  Inner  and  outer  launch  boundaries.  These 
are  defined  as  the  minimum  and  maximum  range  from  which  the  missile  can 
be  launched  and  achieve  a  hit.  The  boundaries  are  a  function  of  the 
Initial  conditions  of  the  engagement  such  as  speed,  altitude,  relative 
attitude,  and  geometry.  The  geometry  of  the  engagement  Is  defined  by 
the  off-boreslght  angle  and  the  aspect  angle.  Figure  5.4  depicts  these 
angles.  The  off-boresight  angles  (OBA)  are  defined  as  the  angles 
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Figure  5.4  ENGAGEMENT  GEOMETRY 

(azimuth  and  elevation)  between  the  missile  velocity  vector  and  the 
LOS.  The  aspect  angles  are  defined  as  the  angles,  measured  from  the 
tail  of  the  target,  between  the  target  velocity  and  the  missile  LOS.  In 
all  of  the  cases  studied,  the  target  and  missile  are  co-speed  (.7  Mach) 
and  approximately  co-altitude  (10,000  feet)  at  launch. 

Previous  work  [1,9]  with  the  linear  optimal  control  presented  by 
Fiske  [8]  utilized  an  "evasive"  target  maneuver  developed  by  the  Air 
Force  Armament  Laboratory.  This  maneuver  has  two  phases.  For  a  target 
aspect  angle  less  than  90  degrees  (tall  shot)  at  a  range  of  6000  feet, 
the  target  accelerated  into  the  missile  at  an  angle  of  45  degrees  (down) 
with  respect  to  the  vertical.  For  a  target  aspect  angle  greater  than  90 
degrees,  the  target  also  rolls  Into  the  missile,  except  that  this  time 
the  angle  is  45  degrees  up  with  respect  to  the  vertical.  In  each  case, 
at  one  second- to-go  the  target  rolls  to  180  degrees  and  accelerates  down 
(positive  Z  direction).  Unfortunately,  this  Is  not  a  very  evasive 
maneuver.  To  begin  with,  by  automatically  rolling  into  the  missile  the 


maneuver  actually  reduces  rather  than  increases  the  angular  travel,  the 
line  of  sight  rates,  and  the  average  acceleration  required.  Also,  for 
the  short  range  shots,  the  fact  that  the  target  is  maneuvering  at  a 
45  degree  angle  while  the  missile  is  waiting  for  the  clearance  delay  (.4 
seconds)  reduces  the  amount  of  ROLL  required  to  place  the  target  in  the 
primary  maneuver  plane.  Recalling  the  limitations  of  the  missile  and 
the  formulation  of  the  guidance  laws,  much  simpler  and  more  effective 
maneuvers  can  be  devised. 

First,  consider  the  implementation  of  the  target  used  for  this 
evaluation  of  the  Linear  Optimal  Control  Laws.  The  target  is  a  three 
(3)  dimensional,  nine  (9)  "g"  maneuvering  target.  In  order  to  prevent 
the  computational  burden  of  integrating  target  accelerations  for 
velocity  and  position,  the  target  is  mechanized  by  computing  the  radius 
of  curvature  and  the  angular  velocity  of  a  constantly  accelerating  point 
and  incorporating  the  equations  as  uniform  circular  motion.  The  plane 
of  maneuver  for  the  target  is  determined  by  the  target  ROLL  angle,  an 
input  parameter.  When  the  maneuver  is  initiated,  the  center  of 
rotation,  radius  of  curvature,  and  the  coordinate  transformations  are 
computed.  Then,  the  inertial  positions,  velocities,  and  accelerations 
are  computed  by  transforming  the  maneuver  plane  motion,  a  simple 
function  of  the  angle  of  rotation  referenced  to  the  start  of  the 
maneuver,  to  the  inertial  reference  system. 

Using  this  target,  a  deterministic  evaluation  of  the  inner  launch 
boundary  was  initiated  using  an  Improved  six  degree  of  freedom 
simulation  based  on  the  simulation  used  in  [1].  It  soon  became  obvious 
that  the  concept  of  Inner  and  outer  launch  boundaries  for  these 
missile/guidance  law  combinations  did  not  apply.  The  launch  boundaries 
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are  supposed  to  define  an  envelope  within  which  the  missile  will 
intercept  the  target.  This  is  not  the  case  with  the  bank-to-turn 
missile  and  linear  guidance  laws.  To  illustrate  this  point,  consider 
the  trajectory  shown  in  Figure  5.5.  The  launch  range  is  5000  feet,  the 
OBA  is  40  degrees,  and  the  aspect  angle  is  180  degrees.  At  launch,  the 
target  begins  a  level  9  “g"  turn  away  from  the  missile.  Midway  through 
the  flight,  the  guidance  law  essentially  has  the  intercept  conditions 
met  and  reduces  the  acceleration  commands.  Toward  the  end  of  the 
attempted  intercept,  however,  increased  accelerations  are  required,  the 
missile  control  saturates,  and  the  missile  misses  a  relatively  simple 
intercept.  The  miss  was  not  caused  by  a  lack  of  maneuver  capability, 
the  basis  for  the  launch  envelope,  but  by  neglected  attitude  dependent 
constraints. 
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Time- to- go 


The  incorporation  of  the  modified  Tgo  algorithm  significantly 
improved  the  estimate  of  this  parameter.  Since  the  actual  Tirse-to-go  is 
a  function  of  the  trajectory,  and  the  trajectory  is  a  strong  function  of 
Tgo,  it  is  not  possible  to  directly  compare  the  algorithms.  Therefore, 
a  comparison  of  the  actual  Time-to-go  and  the  estimate  of  Tgo  can  be 
made  for  trajectories  with  the  same  initial  conditions. 

After  the  simulated  intercept,  the  time  of  the  closest  approach 
(final  time)  was  calculated.  Simulated  time  was  then  subtracted  from 
the  final  time  to  determine  the  actual  Time-to-go.  This  value  is  then 
compared  to  the  estimate  of  Tgo  generated  during  the  simulation. 
Representative  results  are  presented  in  Figures  5.5  to  5.8.  In  these 
figures,  the  actual  and  estimated  Time-to-go  is  plotted  versus  the  time 
from  launch.  Figures  5.5  and  5.6  came  from  a  run  with  an  azimuth  OBA  of 
40°  and  aspect  of  180°  and  an  initial  range  of  7000  feet.  Figures  5.7 
and  5.8  are  from  the  same  geometry  with  an  initial  range  of  5000  feet. 

The  first  set  of  Tgo  figures  represents  a  relatively  easy 
trajectory  where  the  missile  actually  reverses  its  initial  direction  of 
acceleration  during  the  Intercept.  Since  Riggs'  algorithm  overestimates 
the  closure  velocity.  It  consistently  underestimates  the  Time-to-go. 
The  modified  algorithm  assumes  that  an  intercept  has  been  established; 
therefore,  it  will  under  or  overestimate  the  Time-to-go  depending  on 
whether  the  missile  is  leading  or  lagging  the  target. 

The  Tgo  plots  for  the  5000  foot  Initial  conditions  Illustrate  tho 
performance  for  a  more  difficult  trajectory.  Here,  the  average  missile 
acceleration  Is  higher  and  It  consistently  lags  the  target.  Since  a 
true  Intercept  condition  is  not  established  until  late  in  the  Intercept, 
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Figure  5.8  TGO  PERFORMANCE— RIGGS  ALGORITHM  (5000  FEET) 


the  absolute  performance  of  the  modified  Tgo  algorithm  is  not  as  good  as 
the  easier  trajectory.  Two  points  should  be  noted  however.  Just  as  in 
Riggs'  algorithm,  the  Time-to-go  is  underestimated  during  the  higher  "g" 
trajectory  when  the  missile  Is  lagging  the  target.  This  error  leads  to 
higher  accelerations,  and  if  possible,  an  intercept.  Consequently,  the 
estimate  results  in  a  stable  trajectory  and  the  error  will  decay  in 
time.  Also,  the  absolute  estimate  error  is  always  smaller  than  Riggs' 
algorithm.  Table  5.3  presents  the  average  Tgo  errors  for  the  four 
trajectories  presented  in  the  figures. 


Table  5.3  Average  Tgo  Estimate  Errors 


Initial  Range 

Algorithm 

Average  Error 

7000 

Riggs' 

.21 

Modifl ed 

.07 

5000 

Riggs' 

.26 

Modified 

.16 

Nonlinear  Control  Laws 

The  final  item  to  be  covered  is  the  performance  of  the  nonlinear 
control  law  derived  in  Chapter  4.  The  control  law,  along  with  SI,  (and 
an  Improved  pro-nav  guidance  law)  were  Incorporated  in  the  simulation 
outlined  in  Appendix  C.  The  simulation  was  verified  and  compared 
remarkably  well  with  the  larger,  more  complex  simulation  discussed 
previously.  (The  complex  simulation  predicted  a  75  foot  miss  at  3500 
feet  versus  a  193  foot  miss;  other  results  were  closer.) 

The  trajectory  presented  here  has  the  same  initial  geometry  as  the 
previous  engagements— 40  degree  OBA  with  a  180  degree  aspect  angle.  The 
Initial  range  varies  from  3400  feet  to  7000  feet. 


The  performance  of  the  nonlinear  control  law  was  significantly 
better  than  61.  First,  the  nonlinear,  or  Bank-to-turn  (BTT),  law  was 
able  to  achieve  a  hit  (miss  distance  less  than  20  feet)  inside  the  range 
of  61.  Secondly,  in  every  case  where  61  was  able  to  score  a  hit,  the 
miss  distance  of  the  BTT  control  law  was  at  least  25%  of  61.  Also, 
throughout  the  trials,  the  BTT  accuracy  was  consistent  while  the 
performance  of  the  linear  guidance  laws  was  quite  erratic.  And  third, 
the  time  to  intercept  for  the  BTT  law  was  less  than  the  linear  control 
law. 

Four  launch  ranges  are  presented:  3400,  3500,  5000,  and  7000 
feet.  Table  5.4  summarizes  the  results  of  these  launches. 

Table  5.4  Control  Law  Performance 


Initial 

Control 

Miss 

Time 

Range 

Di stance 
( feet) 

(sec) 

7000 

61 

19 

2.75 

BTT 

4 

2.61 

5000 

61 

37 

2.20 

BTT 

4 

2.15 

3500 

61 

193 

1.75 

BTT 

5 

1.65 

3400 

BTT 

52 

1.70 

The  details  of  any  number  of  trajectories  could  be  presented,  but 
the  most  Instructive  are  the  runs  from  3500  feet.  Figures  5.10  and 
5.10B  contain  the  trajectory  and  acceleration  commands  for  the  BTT 
simulation,  and  Figures  5.11A  to  5.1  IB  have  the  results  of  61.  Since 
both  sets  of  N_  commands  are  saturated  for  most  of  the  trajectory  and 


8TT  only  deviates  22  feet  In  altitude.  It  Is  obvious  that  a  hit  could 
not  be  achieved  from  a  shorter  Initial  range  unless  the  roll  rate  is 
increased  to  allow  a  quicker  roll  and  turn.  The  reason  for  the  Improved 
performance  is  also  clear.  Neglecting  the  constraints  in  the  guidance 
law  results  in  a  rolling  attack  as  the  acceleration  vector  is  rotated  by 
unequal  limits.  Consequently,  it  is  more  difficult  to  control  the  roll 
angle  which  is  the  real  control  over  the  direction  of  the  acceleration 
vector,  and  roll  rate  commands  stay  large  during  the  run.  Since  the  BTT 
control  law  generates  a  ROLL  command  consistent  with  the  Nz  command,  the 
ROLL  angle  Is  properly  regulated,  and  roll  rates  decrease  to  5  to  7 
degrees  per  second  during  the  terminal  phase  of  the  intercept. 


Intercep 


CHAPTER  VI 
CONCLUSIONS 


This  research  has  identified  and  corrected  a  major  shortcoming  in 
the  formulation  and  implementation  of  advanced  guidance  laws  for  a  Bank- 
to-turn  missile.  The  Bank-to-turn  (BTT)  guidance  law  was  demonstrated 
on  a  six  degree  of  freedom  simulation  developed  to  support  the  analysis 
of  advanced  guidance  and  control  laws. 

The  most  significant  limitation  of  the  advanced  guidance  techniques 
was  the  neglect  of  inequality  constraints  on  the  control  variables. 
These  effects  were  evaluated  using  a  one-dimensional  model  that 
highlighted  the  effects  of  the  constraints  and  identified  a  method  to 
incorporate  them  in  the  formulation  of  the  guidance  law.  The  most 
significant  conclusion  is  that  while  control  saturation  is  optimal  for 
an  initial  constraint,  final  constraints  pose  particular  problems  and 
must  be  anticipated  by  adjusting  intermediate  boundary  conditions  for 
the  unsaturated  portion  of  the  trajectory. 

A  careful  analysis  of  the  trajectories  that  result  from  the  linear 
guidance  laws  Indicated  that  the  launch  envelopes  determined  by  past 
research  were  not  completely  correct.  In  fact,  an  evading  target  could 
use  the  limitations  Imposed  by  the  missile  acceleration  control 
constraints  and  generate  a  miss  even  In  the  heart  of  the  missile  launch 
envel ope. 
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Rigg's  algorithm,  used  in  the  computation  of  the  Time-to-go,  was 
improved  by  accounting  for  the  angular  differences  between  the  velocity 
vector  of  the  missile  and  the  direction  of  the  target. 

Lastly,  the  incorporation  of  the  first  order  terminal  controller 
mentioned  above  as  an  "attitude"  controller  resulted  in  a  nonlinear 
Bank-to-turn  guidance  law  that  exhibited  exceptional  performance.  The 
guidance  law  was  able  to  limit  the  miss  distance  to  four  or  five  feet 
inside  the  launch  envelope,  shorten  the  time  of  flight  when  compared  to 
linear  guidance,  and  decrease  the  inner  launch  boundary  to  a  point  where 
a  near  constant  maximum  control  still  resulted  in  a  hit. 


APPENDIX  A 

TASC  LINEAR  GUIDANCE  LAWS 


The  linear  guidance  laws  G1  and  G2  developed  by  Fiske  [8]  are 
reproduced  here  to  provide  an  indication  of  the  type  of  control  laws 
under  discussion.  Guidance  laws  G3  and  G4  are  an  extension  of  G1  and  G2 
that  add  first  and  second  order  missile  dynamics.  As  a  result,  they 
contain  numerous  additional  terms  and  do  not  provide  additional  insight 
into  the  form  of  the  guidance  laws.  Consequently,  they  are  not 
repeated,  and  the  reader  is  referred  to  [8].  Although  Riggs  and  Verges 
[11]  continued  with  the  work  of  [8]  and  studied  guidance  laws  GL1-GL8, 
these  are  not  the  same  set  of  guidance  laws  but  are  G1  and  G2  with 
different  Tgo  computation. 

Since  the  attitude  of  the  missile  was  not  considered,  the  guidance 
laws  are  the  same  for  each  direction.  Only  the  X  direction  is  given, 
the  remainder  are  similar. 

Guidance  Law— G1 

n  =  {  — ^132)  }  x  +  {  — 3{-T-gq)2  }  vx 

x  3v  +  (Tgo)3  3v  +  (Tgo)3  x 


Guidance  Law— G2 
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APPENDIX  B 

COORDINATE  TRANSFORMATIONS 

This  appendix  outlines  the  coordinate  transformations  used  for  the 
control  laws  and  the  simulation  and  is  included  to  clarify  the 
relationships  of  the  various  references.  Unfortunately,  there  is  no 
standard  set  of  Euler  angles.  Confusion  arises  from  the  use  of  left- 
handed  systems  as  well  as  the  order,  direction,  axis,  and  reference  of 
the  rotations.  The  following  set  of  Euler  angles  is  not  the 
"conventional"  set  as  defined  by  Goldstein  [24]  but  follows  the 
convention  outlined  in  [25,26,27]. 

Definitions 

Missile  Euler  Angles  (Figure  5.1) 

Those  rotations,  in  the  order  of  YAW,  PITCH,  and  ROLL,  are  required 
to  re-orient  the  missile  from  the  Inertial  reference  frame  to  the 
current  body  frame  orientation.  The  inertial  reference  is  defined  as 
the  orientation  of  the  body  axis  at  time  zero. 

The  body  axis  system  is  fixed  to  the  center  of  gravity  of  the 
missile  with  the  positive  x  axis  pointing  forward  along  the  fuselage 
reference  line.  The  positive  z  axis  points  downward  toward  the  bottom 
of  the  vehicle,  with  the  y  axis  completing  the  right  handed  system  (out 
the  right  side). 

YAW  4>:  The  angle  between  the  projection  of  the  x  body  axis  onto  the 

inertial  XY  plane  and  the  X  inertial  axis. 
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PITCH  0:  The  angle  measured  in  the  vertical  plane  between  the  x  body- 


axis  and  the  inertial  XY  plane. 

ROLL  <j>:  (Bank)  Angle  measured  in  the  yz  plane  of  the  body  system 
between  the  y  body  axis  and  the  YX  inertial  plane. 

Seeker  Angles  (Figure  B.2) 

The  orientation  of  the  seeker  line  of  sight  (LOS)  and  missile  body 
axis  are  defined  by  seeker  gimbal  azimuth  and  elevation  angles  <j>g  and 
9g,  respectively. 

GMB  PSI  4>g:  The  angle  between  the  projection  of  the  LOS  onto  the 
missile  xy  plane  and  the  X  body  axis. 


GMB  THT  0a:  The  angle  between  the  LOS  and  the  missile  xy  plane. 


Transformations 


Missile 

YAW: 


PITCH: 


Inertial  to  Body  Axis 

YAW  is  a  clockwise  rotation  about  the  inertial  Z  axis  while 
looking  in  the  positive  Z  direction. 


PITCH  is  a  clockwise  rotation  about  the  current  y‘  body  axis 
while  looking  in  the  positive  y'  direction. 


Figure  B.4  PITCH  ANGLE  ROTATION 


cos  e 

0 

-sin  el 

/  *'\ 

2 

0 

1 

0 

y’ 

\sin  e 

0 

cos  ej 

\w 

ROLL:  ROLL  Is  a  clockwise  rotation  about  the  current  x"  axis  while 

looking  in  the  positive  x"  direction. 

y" 
y 


Figure  B.5  ROLL  ANGLE  ROTATION 

1  0  0  \  I  x"\ 

0  cos  <t>  sin  <|> ]  y"l 

0  -sin  *  cos  * /  \z"/ 

Combining  the  three  rotations  in  the  proper  order  generates  the  general 
transformation  from  Inertial  to  body  coordinates: 

cose  cos*  cose  sin*  -sine 

0  =  sin*  sine  cos-;,  -  cos*  sin*  sin*  sine  sin*  +  cos<i>  cos*  sin<(»  cose 

cos*  sine  cos*  ♦  sin*  sin*  cos*  sine  sincj>  -  sin*  cos*  cos*  cose 

Since  the  transformation  Is  orthogonal,  the  transformation  from  body  to 
inertial  Is  the  transpose  of  D. 

Missile  Body  to  Seeker  LOS 


Figure  B.6  GIMBAL  AZIMUTH  ANGLE  ROTATION 


/x'\  /  cos  <j,g  sin  <pg  0 

y'  =  I  -sin  <|)g  cos*  0 
\z7  \  0  0  1 

Seeker  PITCH:  The  seeker  PITCH,  gimbal  theta  (0g),  i 
the  y‘  seeker  axis  while  looking  i 
di recti on . 


s  a  rotation  about 
n  the  positive  y' 


Figure  B.7  GIMBAL  PITCH  ANGLE  ROTATION 


Consequently,  the  final  transformation  from  the  body  to  seeker  reference 


SEEK  = 


cos  9  _  COS  (J< 

g  Tg 


cos  e_  sin  <b 
g  ^g 


-sin  4,  cos  4, 

sin  9_  cos  4»_  sin  9,,  sin  4. 


-sin  9. 


cos  9, 


APPENDIX  C 
SMALL  SIMULATION 


Appendix  C  presents  the  approximate  equations  of  motion  and  code 
for  the  first  order  missile  simulation.  The  appendix  is  divided  into 
three  sections:  the  equations  of  motion,  the  seeker  model,  and  the 
simulation. 

Missile  Equations  of  Motion 

The  first  section  contains  the  derivation  of  the  approximate 
equations  of  motion  used  in  the  simulation  to  transform  control  inputs 
to  Inertial  Euler  angle  rates. 

Using  the  Euler  angle  definitions  of  Appendix  B,  a  transformation 
can  be  derived  that  accounts  for  the  effect  of  the  control  inputs, 
linear  accelerations,  and  roll  rate  on  the  inertial  attitude  of  the 
missile  [26,29]. 

Two  sets  of  relationships  are  required.  The  first  is  the 
transformation  between  the  body  axis  rates:  p,  q,  and  r,  and  Inertial 
Euler  angle  rates  $  9  The  second  relationship  is  rhe  response  of  the 
missile  to  input  commands.  The  following  derivation  follows  [26]. 

Definitions 

The  linear  velocity  of  the  missile,  expressed  in  terms  of  body  axis 

AAA 

coordinates  Is:  V  3  ui  +  vj  +  wk 

where  u  3  forward  velocity 
v  3  side  velocity 
w  3  vertical  velocity 


The  angular  velocity  of  the  missile  also  expressed  in  the  body  reference 


system  is: 


where  p  *  ROLL  rate 
q  =  PITCH  rate 


r  *  YAW  rate 


w  =  pi  +  qj  +  rk 


Angular  Velocity  Transformation 

Because  the  Euler  angles  are  defined  in  YAW,  PITCH,  ROLL  sequence, 
this  sequence  must  be  maintained  in  determining  the  angular  velocity 
transformation. 


Resolve  components  of  YAW  rate  | 


HmIuE 


A  ROLL  angle  will  not  change  the  effect  of  <j>  on  p,  and  the  PITCH 
and  ROLL  rate  components  are: 

q  =  l  cos  9  sin  <t> 
r  =  <£  cos  9  cos  <j> 


Figure  C.3  YAW  RATE  COMPONENTS— ROLL 
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Resolve  components  of  PITCH  rate  9 

With  the  missile  in  a  positive  PITCH  attitude,  it  can  be  seen 
immediately  that  the  YAW  angle  will  not  have  any  effect  on  the 
resolution  of  the  inertial  PITCH  rate.  Also,  when  pitched  up,  the  y 
body  axis  remains  in  the  X-Y  inertial  plane.  Consequently,  an  inertial 
PITCH  rate  will  equal  the  body  axis  rate: 


Figure  C.4  PITCH  RATE  COMPONENTS— PITCH 


Once  the  missile  has  a  nonzero  ROLL  angle,  components  of  9  will 


show  up  as: 
q  *  9  cos  <t> 


R  -  $  CO!  <b 


Figure  C.5  FITCH  RATE  COMPONENTS— ROLL 
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Note  that  the  body  axis  ROLL  rate  p  is  not  affected  by  9  since  9  is 
measured  with  respect  to  an  axis  orthogonal  to  the  x  body  axis. 

Resolve  the  components  of  ROLL  rate  $ 


Since  $  is  measured  along  the  x  body  axis  by  definition,  it  will 
affect  the  value  of  p  only. 


Combined  Transformation 

The  components  of  the  inertial  angular  velocities  with  respect  to 
the  missile  body  axis  can  be  combined  to  give  the  following 
transformation: 


0  -sin  9  \  / <(> 

cos  $  sin  $  cos  9  0 

■sin  <t>  cos  <j>  cos  9/  \4> 


Inverse  Transformation 

In  order  to  account  for  the  affect  of  the  control  inputs  on  the 
attitude  of  the  missile,  the  inverse  of  the  above  transformation  is 
needed.  The  determinant  of  the  transformation  matrix,  however,  is  equal 
to  the  cos  9.  Consequently,  at  ±90  degrees  of  PITCH,  the  inverse  of  the 
transformation  is  not  defined,  but  from  the  geometry  of  the 
transformations,  the  Inverse  can  be  seen  to  be: 


When  the  cos  9  *  0,  then  the  inverse  of  the  transformation  can  be 
computed  as: 


sin  <t>  tan  9 
cos  <|) 

sin  $/ cose 


cos  <j>  tan  9 
-sin  <)> 

COS  0/COS9 


Missile  Dynamics 

In  order  to  determine  the  effect  of  control  inputs,  the  equations 
of  motion  of  the  missile  must  be  analyzed.  Since  the  missile  has  six 
(6)  degrees  of  freedom  (forward,  sideways,  and  down  translation  as  well 
as  the  PITCH,  ROLL,  and  YAW  rotation),  six  simultaneous  equations  are 
required.  Using  the  linear  force  and  moment  relationships  expressed  in 
an  accelerating  reference  frame  (with  ( dV/dt) j  =  (dV/dt)B  +  u  x  V),  the 
following  equations  can  be  derived  [25,26]: 

Fx  3  m(u  +  qw  -  rv) 

Fz  3  m(w  +  pv  -  qu) 

Fy  =  m(v  +  ru  -  pw) 

=  q  Iy  -  pr  (Iz  -  lx)  +  (p2  -  r2)  Ixz 

Gx  =  p  lx  +  qr  (Iz  -  Iy)  -  (r  +  pq)  Ixz 

Gz  =  r  Iz  +  pq  (Iy  -  lx)  -  (qr  -  p)  Ixz 

Here,  the  left  hand  side  represents  applied  forces  (F^)  and  moments  (G^) 
while  the  right  hand  side  provides  the  missile  response  as  a  function  of 
moments  of  inertia  and  body  referenced  velocities. 


Equating  the  applied  accelerations  to  the  control  inputs,  and 


incorporating  the  inverse  transformation  (9  *  90° ): 


0 

cos  <|) 
-sin  <j> 


-sin  9 
sin  $  cos  9 
cos  <t>  cos  9i 


This  set  of  equations,  however,  cannot  be  used  to  determine  the  attitude 
dynamics  resulting  from  control  inputs  since  the  inverse  of: 


w  cos  (ji  +  v  sin  $ 
-u  cos  <|> 

-u  sin  <)> 


w  sin  cos  9  -  v  cos  <t>  cos  0 

-v  sin  9  -  u  sin  $  cos  9 

w  sin  9  -  u  cos  <t>  cos  0 


does  not  exist. 

Using  the  applied  accelerations: 

Fx/m  =  u  +  qw  -  rv 
Fz/m  =  w  +  pv  -  qu 
Fy/m  =  v  +  ru  -  pw 

and  restricting  the  missile  velocities  to  the  x  (forward)  direction 
only,  then 

v  =  v  =  w  =  w  =  0 

and  N  *  u  N_  =  -qu  N  =  ru 

a  z  y 

These  assumptions  remove  higher  order  dynamics  about  the  center  of 
gravity  of  the  missile  (Dutch  roll,  Short  Period,  Phugoid  Oscillations, 
and  Directional /Spiral  Divergence)  but  still  allow  dynamics  associated 
with  the  center  of  gravity. 


Using  these  approximations  and  the  inverse  angular  velocity 
transformation,  we  have  the  following  relationships: 

£  3  p  -  sin  <t>  tan  e  (Nz/u)  +  cos  0  tan  9  (Ny/u) 

9  3  -cos  0  (Nz/u)  -  sin  0  (Ny/u) 

=  -sin  0/cos  9  (Nz/u)  +  cos  0/cos  9  (Ny/u) 

Seeker  Model 

While  the  above  relationships  provide  the  necessary  equations  to 
model  the  missile  motions,  the  missile  actually  uses  a  seeker  to 
determine  the  relative  position  of  the  target.  Consequently,  a  seeker 
model  is  required.  Rather  than  model  the  internal  motions  of  the  seeker 
gimbals,  seeker  error  sources,  and  the  stabilization  loops  [7],  a 
simplified  approach  is  taken  where  the  LOS  angles  are  propagated  via: 

GMB  Theta  3  OLOSQ  -  u>y 
GMB  Psi  3  OLOSR  -  u>z 
where  DLOSQ  3  PITCH  line  of  sight  rate 
DLOSR  3  azimuth  line  of  sight  rate 
Uy  3  Missile  motion  affecting  9^ 

wz  3  Missile  motion  affecting  4^ 

The  LOS  errors  are  determined  by  calculating  the  difference  In  the 
predicted  target  location  (using  Gimbal  angles),  and  the  actual  target 
location  (using  simulation  results).  Assuming  a  type  1  system,  the 
feedback  transfer  function  from  9g  (or  <0g)  to  tracking  angle  error  e 
(assuming  perfect  stabilization  and  no  abberations)  is 


Then,  at  low  frequencies,  the  LOS  rate  is  proportional  to  the  tracking 
error  [7].  Therefore,  the  gimbal  errors  are  used  with  a  proportional ity 
constant  to  determine  the  LOS  rate.  Gimbal  motion  due  to  missile 
angular  velocities,  u>y  and  a>z,  are  simply  body  rates  transformed  to  the 
seeker  coordinate  system. 

Simulation 

The  simulation  consists  of  a  15  state  model  that  is  propagated 
using  an  Adams  Predictor-Corrector  [19,28]  with  a  Runge-Kutta  start 
up.  The  equations  of  motion  are  contained  in  the  subroutine  MODEL  while 
other  routines  are  used  for  initialization  and  output.  The  states  are 
relative  cartesian  positions  and  velocities,  target  ROLL  angles,  missile 
Euler  angles,  and  missile  gimbal  angles.  Inputs  are  linear 

accelerations  Nx,  Ny,  Nz,  and  missile  ROLL  rate. 

The  simulation  is  divided  into  three  (3)  parts  so  that  it  can  be 
run  on  a  microcomputer  in  40K  COM  files.  The  code,  however,  is  ANSI 
standard  FORTRAN  and  with  two  changes  for  file  handling,  was  run  on  a 
VAX  1170.  The  first  part  Initialized  the  variables  and  simulated  the 
trajectory.  Data  were  stored  In  two  data  files  Wl.DAT  and  PL0T.DAT. 
These  files  were  read  by  the  second  and  third  programs  for  data 
reporting,  postflight  miss  distance,  Tgo  analysis  and  plotting.  Since 
most  of  the  subroutines  are  straightforward  input-output,  they  are  not 
Included.  The  code  used  to  initialize  the  routines  and  the  subroutine 
MODEL  Is  Included  for  Illustrative  purposes. 

As  mentioned  earlier,  the  simulation  had  15  states:  the  usual  nine 
(9)  for  cartesian  positions,  velocities,  and  accelerations,  two  (2)  to 
propagate  gimbal  angle  dynamics,  one  (1)  (unused)  for  target  ROLL  angle. 
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and  the  remaining  three  (3)  for  the  missile  Euler  angles.  Linear  states 
are  propagated  without  the  effects  of  inertia  or  drag.  But  if  the 
angular  states  were  also  propagated  by  assuming  an  instantaneous  and 
perfect  response  without  damping,  excessive  rates  would  develop. 
Therefore,  it  became  obvious  that  the  bandwidth  of  the  angular 
velocities  had  to  be  limited  in  order  to  produce  reasonable  results. 
Since  the  effects  of  the  linear  accelerations  on  the  angular  rates  no 
included  a  delay,  the  direction  of  the  missile  indicated  by  missile 
velocities  and  Euler  angles  was  no  longer  consistent.  Since  each  was 
propagated  independently,  by  the  end  of  the  run,  a  three  to  five  degree 
discrepency  would  develop  between  them.  In  effect,  there  were  too  many 
states.  Consequently,  at  each  update,  the  Euler  angles  are  corrected  to 
agree  with  the  angles  generated  by  the  linear  velocity  terms. 


"V 


SUBROUTINE  MODEL <T IME ,  YONE ,YPRIME , HIT) 

IMPLICIT  REALX8  <A-I ,K-Z> 

LOGICAL  HIT 

REAL  PLOTX 1 , PL0TX2 , PLOTY 1 , PL0TY2 , PLOT2 1 , PLOTZ  2 
REAL  M I NX , M I NY , MAXX , MAX Y 

INTEGER  I ,N,JSTATE,JINPUT, JCNTRL, JTIME, JLIMIT, JROLL, JOB 
INTEGER  INCHX , INCHY ,NPLOT ,NPTS 
DIMENSION  YONE< 15) ,YPRIME< 15) 

COMMON  /PLOT/PLOTX 1 <  25)  ,PL0TX2<25)  , PLOTY 1< 25) ,PL0TY2(25)  , 
1PLOT2 1(25) i PL0TZ2<  25) ,NPLOT,NPTS 
COMMON  /TRGT/TRG  XI ,TRG  YI ,TRG  21, 

1TRG  VXI  ,TRG  <JYI  ,TRG  <JZI  , 

2TRG  AXI ,TRG  AY I ,TRG  AZ I 
COMMON  /SET/ALT  I D8  ,GMB  TH0  ,  GMB  PS0,RN60,TRG  <J0  , 

1ASP  TH0.ASP  PS0 ,MSL  U0 ,THET0 , PHI  0 , PSI 0 ,TH0 ,CSPSI 0 , SNPSI 0 , 
2SNTH0 ,MI SS  DS , STEP , DLAY  SW,TRG  XI0,TRG  YI 0 ,TRG  210, 
3TX0,TY0,TZ0,0LD  T,TRG  PS0.TRG  TH0 ,TRG  PHI,JMAN 
COMMON  /MSL/Y< 15) ,U<4) ,TGO  HT , RNG  I ,VC 
COMMON  /OUT/W 1 < 25 , 25) 

COMMON  /SEEK/  SEEK  11, SEEK  12, SEEK  13, SEEK  21, 

1SEEK  22, SEEK  23, SEEK  31, SEEK  32, SEEK  33,DL0SQ,DL0SR 
COMMON  /OPTION/  JCNTRL, JTIME, JLIMIT, JROLL 

TRIG  FUNCTIONS  FOR  DEGREES 

SIN  OG<X>  -  DSIN<DG  TO  RD  X  X) 

COS  DG<X>  ■  DCOSC  DG  TO  RD  X  X) 

GRAV  -  32. 1725 
DG  TO  RD  ■  .0174532925 
RD  TO  DG  »  57.29577951 
PI  ■  3.141592654 

TWOPI  -  6.283185307 


2.7182818 


TARGET  CONSTANTS 


NMAX 


MISSILE/AUTOPILOT  CONSTANTS 


M  PHI 
H  THETA 
M  PSI 
LAM  DA  X 
LAM  DA  Y 
LAM  DA  2 
AMAX 
AMIN 
DURAT 


15. 

15. 

15. 

10. 

10. 

10. 

580. 

-38. 

2.6 


ooo  oooooo 
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DLAY  SW  »  0.4 
GAMMA  »  IE-4 
NZ  MAX  *  108.XGRAM 
NY  MAX  =»  5. X GRAM 
P  MAX  =  588. XDG  TO  RD 
C 

MSL  XI  -  YONE<  1) 

MSL  YI  »  YONE<  2) 

MSL  ZI  »  Y0NE<3) 

MSL  MX  I  »  YONE(  4) 

MSL  MY I  «  Y0NE<5) 

MSL  MZI  -  Y0NE(4) 

LIMIT  ANGLES  TO  2  X  PI 

PHI  =  Y0NE<8> 


CONSTRAIN  PSI  &  THETA  TO  MELOCITIES 

MSL  IXY  -  DSQRT <  <MSL  MXIXX2)  +  <MSL  MYIXX2)) 
PSI  -  DATAN2<MSL  MY I , MSL  MXI) 

THETA  -  DAT AN 2 < -MSL  MZI, MSL  IXY) 

YONE<  ?)  »  THETA 

YONE< 10)  »  PSI 
D  PHI  ■  Y0NE<  11) 

D  THETA  ■  YONE< 12) 

D  PSI  -  YONE< 13) 

GMBTHT  ■  YONE<  14) 

GMBPSI  -  YONE< 15) 

IF<DABS<PHI) .GT.TWOPI) PHI  ■  PHI  - 
1DSIGN<TW0PI , PHI) XDINT<TWOPI/PHI ) 

I F<DABS<THETA) .GT.TWOPI ) THETA  -  THETA  - 
1DSI GN<TWOPI , THETA) XDINT<TWOPI/THETA> 
IF<DABS<PSI) .GT.TWOPI) PSI  ■  PSI  - 
1DSIGN<TW0PI ,PSI) XDINT<TWOPI/PSI) 

I F< DABS< GMB  THT) .GT.TWOPI) GMB  THT  -  GMB  THT  - 
1DSIGN<TW0PI ,GMB  THT) XDINT<TWOPI/GMB  THT) 
IF(DABS(GMB  PSI) .GT.TWOPI) GMB  PSI  «  GMB  PSI  - 
1DSIGN(TW0PI ,GMB  PSI ) XDINT<TWOPI/GMB  PSI) 

INERTIAL  TO  BODY  DIRECTION  COSINES 

Dll  ■  DCOS(THETA) XDCOS( PSI ) 

D12  ■  DCOS(THETA) XDSIN< PSI) 

D 13  ■  -  DSIN(THETA) 

D21  ■  DSIN<PHI) XDSIN(THETA) XDCOS<PSI)  - 
1  DCOS<  PHI ) XDSIN<  PSI ) 


D22  -  DSIN<PHI ) XDSIN(THETA) XDSIN( PSI )  + 

1  DCOS(PHI) XDCOS(PSI) 

D23  -  DSIN( PHI )XDCOS (THETA) 

D31  -  DCOS(PHI) XDSIN(THETA) XDCOS(PSI)  + 

1  DSIN< PHI ) XDSIN( PS I > 

032  -  DCOS( PHI >  XDSIN(THETA) XDSIN( PSI)  - 
1  DSIN(PHI) XDCOS(PSI) 

033  «  DCOS(PHI) XDCOS(THETA) 

COMPUTE  BODY  COORD  VELOCITY  (BODY  TO  INERTIAL) 

MSL  VXB  *  DSQRT ( (MSL  VXIXX2)  +  (MSL  VYIXX2)  +  (MSL  VZIXX2)) 
CHECK  FOR  SINGULAR  INVERSE 

IF(DABS(THETA-(PI/2.) ) .LE.DG  TO  RD)  GOTO  168 

All  -  DSIN( PHI ) XDSIN(THETA) /( DCOS(THETA) XMSL  VXB) 

A 12  ■  DCOS ( PHI )XDSIN( THETA) /(DCOS( THETA) XMSL  VXB) 

A21  -  DCOS( PHI ) X ( 1/MSL  VXB) 

A22  ■  DSIN(PHI)X( 1/MSL  VXB) 

A31  -  DSIN( PHI )/(DCOS( THETA) XMSL  VXB) 

A32  -  DCOS( PHI )/(DCOS (THETA) XMSL  VXB) 

188  CONTINUE 

COMPUTE  PITCH  RATES  IN  BODY  AXIS 
PM  -  D  PHI  -  D  PSI XDSIN(THETA) 

QM  -  D  THETAXDCOS(PHI)  ♦  D  PSIXDSIN(PHI) XDCOS(THETA) 

RM  — D  THETAXDSIN(PHI)  ♦  D  PSI XDCOS( PHI) XDCOS( THETA) 

XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX 

XXXX  xxxx 

XXXX  T*rg#t  Equations  o-f  Motion  XXXX 

XXXX  XXXX 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 

IF(RNG  I .LE. 6888.) GOTO  288 

TRG  XI  -  TRG  VXI  X  TIME  ♦  TRG  XI 8 
TRG  YI  -  TRG  VYI  X  TIME  +  TRG  YI8 
TRG  Z1  ■  TRG  VZI  X  TIME  ♦  TRG  ZI8 

TXO  -  TRG  XI 

TYO  *  TRG  YI 

TZO  -  TRG  ZI 


OLD  T 


TIME 


83 


aV 

m 


TV* 


•rvvri.*'.*Vro 


m 


,v‘  i 


p»v 


-„■- 


IA. 


lA 


R: 
>  . 
«%• 


m 


fe£ 


£ 


JMAN  -  0 
GOTO  338 
280  CONTINUE 

IF< JMAN.EQ. 1)  GOTO  230 
INITIALIZE  MANUEVER 
COMPUTE  TARGET  ROLL  ANGLE 


C 

C 

C 


C 

C 

c 

c 

c 


c 

c 

c 


♦  TRG  PHI 
-  TRG  PHI 


RIGHT  ROLL 
LEFT  ROLL 


IF<TRG  PHI. GE. 180.)  TRG  PHI  »  TRG  PHI  -  360. 
IF<TRG  PHI .LE.- 180.)  TRG  PHI  -  TRG  PHI  +  360. 


DETERMINE  THE  RADIUS  OF  CURVATURE  8c  ANGULAR  VELOCITY 


TRG  R  » 
PS  DOT 


<TRG  V0XX2)/<NMAXXGRAV) 

>  RD  TO  DG  X  TRG  V8/TRG  R 


COMPUTE  DIR  COSINES  FOR  AXIS  OF  ROTATION 


80DY  TO  INERTIAL 


DT11 

DT21 

DT31 

DT12 


1 


DT22 


1 


DT32 
DTI  3 


1 


DT23 


DT33 


•COS  DG<TRG  TH0) XCOS  DG<TRG  PS0) 

•COS  DG<TRG  TH0) XSIN  DG<TRG  PS0> 

—SIN  DGCTRG  TH0) 

•SIN  DG<TRG  PHI) XSIN  DG<TRG  TH0) XCOS  DG(TRG  PS0> 
-COS  DG<TRG  PHI) XSIN  DG<TRG  PS0> 

•SIN  DG<TRG  PHI) XSIN  DG<TRG  TH0)XSIN  D6(TRG  PS0) 
♦COS  DG(TRG  PHI) XCOS  DG(TRG  PS0) 

•SIN  DG<TRG  PHI) XCOS  DG<TRG  TH0> 

•COS  DG<TRG  PHI) XSIN  DG<TRG  TH0)XCOS  DGCTRG  PS0> 
♦SIN  DG<TRG  PHI) XSIN  DG<TRG  PS0> 

•COS  DG<TRG  PHI) XSIN  DG<TRG  TH0)XSIN  DG<TRG  PS0) 
-SIN  DG<TRG  PHI) XCOS  DG<TRG  PS0> 

•COS  DG<TRG  PHI) XCOS  DG<TRG  TH0) 


COMPUTE  TXI0  jTYI 0 ,TZ 10  < ORIGIN  FOR  ROTATION) 


XP  ■ 

0. 

YP  - 

0. 

ZP  - 

-TRG  R 

TXI0 

-  DT11XXP 

♦ 

DT12XYP 

+ 

DT13XZP 

♦ 

TXO 

TYI 0 

■  DT21XXP 

♦ 

DT22XYP 

♦ 

DT23XZP 

♦ 

TYO 

TZI0 

«  DT31XXP 

♦ 

DT32XYP 

♦ 

DT33XZP 

♦ 

TZO 

RESET  TRG  PS0  FOR  NEW  SYSTEM 

TRG  PS0  =  0. 

YP  =0. 

WP  *  0. 

AYP  *  0. 

JMAN  *  1 

250  CONTINUE 

TRG  PS  *  TRG  PS0  +  PS  DOT* (TIME-OLD  T) 

ZP  -  TRG  RXCOS  DG<TRG  PS) 

VZP  *  -  TRG  V0XSIN  DG<TRG  PS) 

AZP  -  -<  <TR6  U0XX2) /TRG  R)XCOS  DGCTRG  PS) 

XP  -  TRG  RXSIN  DG(TRG  PS) 

VXP  »  +  TRG  V0XCOS  DG<TRG  PS) 

AXP  *  -<<TRG  V0XX2)/TRG  R)XSIN  DG(TRG  PS) 

TRG  XI  =  DT11XXP  ♦  DT12XYP  +  DT13XZP 
TRG  YI  -  DT21XXP  +  DT22XYP  ♦  DT23XZP 
TRG  ZI  -  DT3IXXP  ♦  DT32XYP  +  DT33X ZP 

TRG  VXI  »  DT11XVXP  +  DT12XVYP  ♦  DTI3XVZP 
TRG  VYI  -  DT21XVXP  +  DT22XUYP  +  DT23XVZP 
TRG  VZI  »  DT31XVXP  +  DT32XVYP  ♦  DT33XUZP 

TRG  AXI  -  DT 1 IX AXP  +  DT12XAYP  +  DTI3XAZP 
TRG  AY I  -  DT21XAXP  +  DT22XAYP  +  DT23XAZP 
TRG  AZI  -  DT3IXAXP  ♦  DT32XAYP  +  DT33XAZP 

TRG  XI  -  TRG  XI  ♦  TXI0 
TRG  YI  *  TRG  YI  ♦  TYI0 
TRG  ZI  *  TRG  ZI  ♦  TZI0 

XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX 

xxxx  xxxx 

XXXX  R*1  *t i v®  T*rg«t-Mi ssi  1  •  Po*  ic  XXXX 

XXXX  xxxx 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 


300  CONTINUE 

XI  HT  ■ 
YI  HT  - 
ZI  HT  - 


TRG  XI 
TRG  YI 
TRG  ZI 


MSL  XI 
MSL  YI 
MSL  ZI 


RNG  XI  =  XI  HT 
RNG  Y I  =  YI  HT 
RNG  21  =  21  HT 

RNG  I  *  DSQRT  <  <  RNG  XIXX2)+<RNG  YIXX2)+<RNG  2IXX2)) 
CHECK  RNG  I 

IF<DABS<RNG  D.LT.MISS  DS) HIT- .TRUE . 

I F<  DABS<  RNG  D.LT.MISS  DS) WRITE<  1 ,  19 10) 

IF<DABS<  RNG  D.LT.MISS  DS) RETURN 

VXI  HT  -  TRG  VXI  -  MSL  VXI 

VYI  HT  =  TRG  VYI  -  MSL  VYI 

V2I  HT  =  TRG  V2 1  -  MSL  V2  I 

VC  =  <TRG  VXI  -  MSL  VXD  X  <  RNG  XI) 

+  <TRG  VYI  -  MSL  VYI)  X  < RNG  YI) 

!  +<TRG  V2I  -  MSL  V2I)  X  <  RNG  21) 

VC  *  VC/ RNG  I 

CHECK  VC 

IF<VC  .EQ.8.) HIT-. TRUE. 

IF<VC  .EQ.0.)WRITE< 1 , 1000) 

I F <VC  . EQ.0 .) RETURN 

DETERMINE  IF  HIT 

IF<RNG  I  -  DABS<VC) X STEP. LE. MISS  DS) HIT- .TRUE . 

CALCULATE  THE  INTERCEPT  ASPECT  ANGLE 

VX8  HT  -  D11XTRG  VXI  +  D12XTRG  VYI  +  D13XTRG  V2I 

VYB  HT  -  D21XTRG  VXI  +  D22XTRG  VYI  ♦  D23XTRG  V2I 

V2B  HT  -  D31XTRG  VXI  ♦  D32XTRG  VYI  +  D33XTRG  V2I 

VBX2  -  DS<3RT<<VXB  HTXX2)+<V2B  HTXX2) ) 

VB  HT  «  DSQRT <  <VBX2XX2) +  <  VYB  HTXX2) ) 

I NT  ASP  -  DATAN  <V2B  HT/VXB  HT) 

INT  ASP  -  INT  ASP  +  GMB  THT 
I F<VXB  HT.LT.0.)  INT  ASP  -  PI  -  INT  ASP 

XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX 
X¥¥X  XXXX 

XXXX  S««K»r  Module  XXXX 

XXXX  XXXX 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 


no  o  o  ooooooo  o  o  o  ooo  o  n  ooo 
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400  CONTINUE 

SEEKER  ANGLES  (BODY  TO  SEEKER) 

SEEK  11  =  DCOS  <  GMB  THT)  X  DCOS  ( GMB  PSI) 

SEEK  12  =  DCOS  (GMB  THT)  X  DSIN  (GMB  PSI) 

SEEK  13  =-  DSIN  (GMB  THT) 

SEEK  21  =-  DSIN  (GMB  PSI) 

SEEK  22  =  DCOS  (GMB  PSI) 

SEEK  23  -  0. 

SEEK  31  =  DSIN  (GMB  THT)  X  DCOS  (GMB  PSI) 

SEEK  32  =  DSIN  (GMB  THT)  X  DSIN  (GMB  PSI) 

SEEK  33  =  DCOS  (GMB  THT) 

RNG  XB  =  D11XRNG  XI  +  D12XRNG  YI  +  D13XRNG  21 

RNG  YB  »  D21XRNG  XI  +  D22XRNG  YI  +  D23XRNG  21 

RNG  2B  =  D31XRNG  XI  +  D32XRNG  YI  +  D33XRNG  21 

RNG  BXY=  DSQRT ( ( RNG  XBXX2)+(RNG  YBXX2) ) 

RNG  B2Y-  DSQRT ( ( RNG  2BXX2)+(RNG  YBXX2) ) 

COMPUTE  CORRECT  LOS  ANGLES 

EP  *  DATAN2  (-  RNG  2B,RNG  BXY) 

EY  »  DATAN2  (RNG  YB , RNG  XB) 

SEEK  EP  -  -  GMB  THT  ♦  EP 
SEEK  EY  »  -  GMB  PSI  +  EY 

DLOSQ  -  (20.)  X  SEEK  EP 
DLOSR  ■  (20.)  X  SEEK  EY 

GMB  WY  -  SEEK  21XPM  +  SEEK  22XQM  +  SEEK  23XRM 

GMB  M2  *  SEEK  31XPM  ♦  SEEK  32XQM  +  SEEK  33XRM 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 
xxxx  xxxx 

XXXX  Tim*  to  Go  XXXX 

XXXX  xxxx 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 

300  CONTINUE 

I F<TGO  HT.EQ.0.) HIT-. TRUE. 

IF<TGO  HT.EQ.0 .)MRITE< 1 , 1030) TIME ,TGO  HT 
IF<TGO  HT.EQ.0.) RETURN 

IF< JTIME.EQ.2)  GOTO  310 

RI GG' S  TGO 


ooo  o  o  o  o  ooooooo  ooo 
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A HAT  *  <AMAX  X  <  DURAT-TIME)  + 

1  AMINX<TGO  HT  +TIME-DURAT) >/TGO  HT 

I F < T I ME . GT . DURAT)  AHAT  -  AMIN 
A  INC  -  (VCXX2)  +  4 . 0XAHATXRNG  I 
I F<A  INC.LT.0.)  A  INC  *  VC  XX  2 
TGO  HT  »  2.  X  RNG  I/(DABS(UC)  ♦  DSQRT (A  INC) ) 

C 

GOTO  608 
C 

310  CONTINUE 

MODIFIED  RI GG' S  TGO 

AHAT  -  < AMAX  X < DURAT-TIME) ♦ 

1  AMINX <TGO  HT  +TIME-DURAT) >/TGO  HT 

IF<TGO  HT.LT. DURAT)  AHAT  =  (AMAX  X < DURAT-TIME) ) /TGO  HT 
IF(TIME.GT. DURAT)  AHAT  -  AMIN 
AOFF  *  DATAN2< RNG  BZY.RNG  XB) 

AHAT  »  AHAT  X  DCOS(AOFF) 

A  INC  -  (UCXX2)  ♦  4 . 0XAHATXRNG  I 
IF(A  INC.LT.0.)  A  INC  -  VC  XX  2 
TGO  HT  «  2.  X  RNG  1/<DABS<UC>  +  DSQRT (A  INC)) 

XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX 

xxxx  xxxx 

XXXX  Missile  Control  Law  XXXX 

XXXX  XXXX 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 

608  CONTINUE 

0LDU3  -  U<3) 

I  NT  THT  -  0.0 
I NT  PSI  »  0.0 

U<  1)  -  AMAX 

IF(TIME.GT.DURAT)  U< 1)  -AMIN 
U<2)  -  0. 

U(3)  -  0. 

U<4)  -  8. 

IF(TIME.LT.DLAY  SW>  GOTO  708 
I F ( JCNTRL . EQ . 2)  GOTO  610 
G 1 

TGO  HT3  -  TGO  HT  X  TGO  HT  X  TGO  HT 
CC11  -  3.XTG0  HT/<3.XGAMMA  ♦  TGO  HT3) 


o  o 


ACCEL  COt^D  IN  FT/SECXX2 

MSL  AXI  -  (CC11XXI  HT  +  CC12XVXI  HT) 

MSL  AY I  -  <  CC 1 1XYI  HT  +  CC12XVYI  HT) 

MSL  AZI  »  (CC11XZI  HT  +  CC12XVZI  HT) 

C 

X  COT-ND  -  011XMSL  AXI  ♦  D12XMSL  AY  I  +  D13XMSL  AZI 

U<2)  ■  D21XMSL  AXI  +  D22XMSL  AY I  +  D23XMSL  AZI 

U< 3)  »  D31XMSL  AXI  +  D32XMSL  AY I  +  D33XMSL  AZI 

C 

IF< JCNTRL.EQ.3)  GOTO  620 
C 

GOTO  640 
C 

610  CONTINUE 
C 

TP3  ■  . 05XTGO  HTXDCOS< GMB  PSI) 

IF<TP3.LT. .03)  TP3  -  .03 
C 

U< 3)  -  <PMXDSIN<GMB  PSI)  -  DLOSQ  +  GMB  NY) X 

1  <  <EXX<TP3>  ♦  EXXC-TP3) >/<EXX(TP3>  -  EXX<-TP3)>) 

U<3)  -  U<3)  X  MSL  MXB  /  DCOSCGMB  PSI) 

U<3)  *  0L0U3  ♦  U<3)X.03 

C 

GOTO  630 
C 

620  CONTINUE 
C 

XY  CMND  ■  DSQRT <  <X  C0MNDXX2)  ♦  <U<2)XX2)> 

I NT  THT  ■  DATAN2(-U<3) ,XY  CMND) 

I NT  THT  ■  GMB  THT  ♦  (DLOSQ/20 .)  -  I NT  THT 
I NT  PSI  -  DATAN2(U<2) ,DABS(X  COMND) ) 

I NT  PSI  »  GMB  PSI  ♦  (DLOSR/20 .)  -  I NT  PSI 
TP3  ■  . 03XTGO  HT 

IF<TP3.LT . . 1)  TP3  -  . 1 
C 

U<  3)  -  -GMB  THTX 

1  <  <EXX<TP3)  ♦  EXX  < -TP3) > /<  EXX  <TP3)  -  EXX<-TP3>>> 

U< 3)  ■  U<3>  ♦  2.XINT  THT/<EXX<TP3)  -  EXX<-TP3>) 

U<3>  ■  U<3>  X  MSL  VXB  /  DCOS<GMB  PSI) 

U  MAX  ■  U<3>  X  <NY  MAX  /  U<2)> 

IF<DABS<U<3)> .GT.U  MAX)  U(3)  *  DSIGN(U  MAX,U<3)> 

C 

TP2  ■  TP3 

U<2>  -  +GMB  PSI  X<  <EXX<TP2)  +  EXX<-TP2)> 

1  /< EXX<TP2>  -  EXX<-TP2>>> 

U<2>  -  U<2>  -  2.XINT  PSI/<EXX<TP3)  -  EXX<-TP3>> 

U<2)  ■  U<2>  X  MSL  UXB  /  DCOS<GMB  THT) 


TP4  -  .2XTG0  HT 
I F< TP4.LT . .2)  TP4  -  .2 

U<4)  -  ♦  GMB  PSI  X<<EXX<TP4J  +  EXX<-TP4)J 

1  /<EXX<TP4)  -  EXX< -TP4) >  > 

U<4)  -  U< 4)  -  2.XINT  PSI/<EXX<TP4)  -  EXX<-TP4>> 

GOTO  650 

630  CONTINUE 

TP2  «  TGO  HT 
I F  <  TP2 .  LT . .  2)  TP2  ■  .2 

U<2>  -  +GMB  PSI  X<<EXX<TP2J  ♦  EXX<-TP2)J 

1  /<EXX<TP2J  -  EXX<-TP2JJJ 

U<  2J  -  U<2J  X  MSL  UXB  /  DCOS<GMB  THTJ 

640  CONTINUE 

ACCEL  COMMAND  IN  DEG/SEC  <  P  MAX 

TP4  *  . 4XTG0  HT 
IF(TP4.LT..2)  TP4  -  .2 
SN  THT  *  OSIN  <GMB  THTJ 
CN  THT  *  DCOS  (GMB  THT) 

SN  PSI  -  OSIN  (GMB  PSD 
CN  PSI  -  DCOS  (GMB  PSI) 

K  -  -  (CN  THT  X  SN  PSDXX2  -  (SN  THTXX2) 

SCALE  -  CN  PSI  X  DSQRT ( ( ( SN  PSIXX2)  ♦  K)/<<SN  PSIXX2J 
U  MAX  -  P  MAX  X  SCALE 

U(4)  -  ♦  GMB  PSI  X( ( EXX <TP4>  ♦  EXX(-TP4)> 

1  /(EXX(TP4>  -  EXX<-TP4)>) 

U(4>  -  U(4)  -  2.XINT  PSI/<EXX(TP4)  -  EXX(-TP4)J 

U<  4)  ■  U<4)  /  SCALE 

650  IF( JLIMIT .EQ.0)  GOTO  700 

IF(DABS(U(2))  .GT.NY  MAX)  U(2)  «  DSIGNOMY  MAX,U(2)) 
IF(DABS(U(3) ) .GT.NZ  MAX)  U<3)  -  DSIGN(NZ  MAX,U<3JJ 
IF< JCNTRL.EQ.3)  U(4)  -  U<4)  -  U(3JX 
1DSIN(GMB  PSI >/ (MSL  UXBXDCOS(GMB  PSI)) 

I F( DABS( U( 4)  )  . GT . P  MX)  U(4)  -  OSIGN(P  M4X,U<4)) 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 
xxxx  xxxx 

XXXX  Equations  of  Motion  for  tho  Missilo  XXXX 
XXXX  XXXX 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 


700  CONTINUE 


DT  -  THETA  X  RO  TO  D6 
DP  -  PSI  X  RD  TO  DO 
DPH  -  PHI  X  RD  TO  D6 
DGT  ■  GMB  THT  X  RD  TO  DG 
DGP  -  GMB  PSI  X  RD  TO  DG 
DGIP-  INT  PSI  X  RD  TO  DG 
DGIT-  INT  THT  X  RD  TO  DG 
DGIA-  INT  ASP  X  RD  TO  DG 
U2  ■  U<2>  /  GRAU 
U3  *  -  U<3>  /  GRAV 
U 4  *  U<4)  X  RD  TO  DG 

WRITE< 1 , 1030) TIME ,TGO  HT 
WRITE < 1 , 1040) RNG  I ,DGIA 
WRITE < 1 , 1050) DGT , DGP 
WRITE< 1 , 1040) DGIT ,DGIP 
WRITE ( 1 , 1045) U3 , U2 , U4 
WRITE < 1 , 1070) DPH|DT ,  DP 
WRITE < If  1080) MSL  XI ,MSL  YI ,MSL  ZI 

LINEAR  INPUT  SIGNS  ON  <4,5,4)  OPPOSITE  TO  THE 
BANK  TO  TURN  CONTROL  LAM  FORMULATION 

YPRIMEU)  -  Y0NE<4) 

YPRIME<2)  -  Y0NE<5) 

YPRIME<3)  -  Y0NE<4> 

YPRIME<4)  -  ♦  D1 1XU<  1)  ♦  D21XU<2)  ♦  D31XU<3> 

YPRIME<5)  -  ♦  D12XU<  1)  ♦  D22XU<2)  +  D32XUC3) 

YPRIME<4)  -  ♦  D  13XU<  1)  ♦  D23XUC2)  ♦  D33XU<3) 

YPRIME<7)  -  0. 

YPRIMEC8)  -  YONE(U) 

YPRIME<9)  ■  YONE< 12) 

YPRIME< 10) »  YONE< 13) 

YPRIME<14>-  <  DLOSQ  -  GMB  WY> 

YPRIME<15)«  < DLOSR  -  GMB  WZ> 

IF<DABS<THETA-<PI/2> > . LE.DG  TO  RD)  GOTO  710 

YPRIME<  11)«  -  W  PHI  X  <Y0NE<  1 1) -A12XU<2) +A1 1XU<3) -U<4>  > 
YPRIME<  12)*  -  W  THETA  X  <YONE<  12)  ♦  A22XU<2)  ♦  A21XU<3>) 

YPRIME<  13) ■  -  M  PSI  X  <YONE<  13)  -  A32XU<2)  ♦  A31XU<3)) 

YPRIME<  il>-  0.0 
YPRIME< 12) ■  0.0 
YPRIMEt 13) ■  0.0 


RETURN 


710  CONTINUE 


YPRIME<11>»  -  W  PHI  X  <YONE<  1 1)  -  U<2>/HSL  UXB) 

YPRIME<12)»  -  W  THETA  X  <YONE<  12)  +  <U<3)/MSL  VXB)  > 

YPRIME< 13) ■  -  W  PSI  X  <YONE< 13)  +  U<4>) 

YPRIME(ll)-  -  M  PHI  X  <  -  U<  2)  /MSL  VXB) 

YPRIME<  12) ■  -  W  THETA  X  <  +  <U<3)/MSL  VXB)  > 

YPRIME< 13) *  -  W  PSI  X  <  ♦  U<4)> 

RETURN 

1000  FORMAT <  1H2 ,  ' VC  *  0O 
1010  FORMAT < 1H2 , ' RNG  I  -  0') 

1030  FORMAT < 1H2, 'TIME  -  '  ,E12.4,5X, 'TGO  HT  »  ',E12.4> 

1040  FORMAT<  1H2,  "Range—  '  ,E12.4,5X,  "Aepect  Angle-  "  ,E12.4> 
1090  FORMAT< lH2,"6imb*1  Theta  -  ",E12.4, 

12X, "Gimbal  Pei  -  ",E12.4) 

1060  FORMAT  < 1H2, '  Intercept  Theta  -  ",E12.4, 

12X," Intercept  Pei  -  ",E12.4> 

1065  FORMAT < lH2,'Nz  -  ",E12.4, 

14X,"Ny  ■  *  , E12.4, 

24X ,'P  «  '  ,E12.4) 

1070  FORMAT < 1H2 , "  Ph  i  -  ",E12.4, 

12X, "Theta  -  ",E12.4, 

22X,  'Pei  -  ",E12.4) 

1080  FORMAT < 1H2, "Xm  *  ",E12.4, 

12X, "Ym  -  " , E 12 . 4 , 

22X , "  Zm  -  "  ,E12.4,/) 
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C 

C 

C 


C 

C 

C 

C 


C 

C 

C 


c 


SUBROUTINE  INIT< JOB, HIT) 

IMPLICIT  REALX8  <A-I ,K-2> 

LOGICAL  HIT 

REAL  PLOTX 1 , PL0TX2 , PLOTY 1 , PL0TY2 , PLOT2 1 , PL0TZ2 
REAL  MINX ,MINY ,MAXX ,MAXY 

INTEGER  I ,N , JSTATE , J INPUT , JCNTRL , JTIME , JLIMIT , JROLL , JOB 
INTEGER  INCHX , INCHY ,NPLOT ,NPTS 

COMMON  /PLOT/PLOTX 1 < 25) ,PL0TX2<25> , PLOTY 1<25> ,PL0TY2<25> 
1PLOTZ 1(25> , PL0TZ2< 25) ,NPLOT,NPTS 
COMMON  /TRGT/TRG  XI ,TRG  YI ,TRG  ZI , 

ITRG  VXI,TRG  VYI ,TRG  UZI  , 

2TRG  AXI ,TRG  AY I ,TRG  AZI 
COMMON  /SET/ALT I D8,GMB  TH0 , GMB  PS0,RNG0,TRG  V0 , 

1ASP  TH0 , ASP  PS0.MSL  U0 ,THET0 ,PHI0 ,PSI0 ,TH0 ,CSPSI0 ,SNPSI0 
2SNTH0 ,MISS  OS, STEP, OLAY  SW,TRG  XI0.TRG  YI0 ,TRG  ZI0, 
3TX0,TY0,TZ0,0LD  T,TRG  PS0.TRG  TH0 ,TRG  PHI,JMAN 
COMMON  /MSLyOT<  1S>  ,U<4)  ,TGO  HT ,  RNG  I  ,UC 
COMMON  /OUT/M 1 <  25 , 25) 

COMMON  /SEEK/  SEEK  11, SEEK  12, SEEK  13, SEEK  21, 

1SEEK  22, SEEK  23, SEEK  31, SEEK  32, SEEK  33 , DLOSQ , DLOSR 
COMMON  /OPTION/  JCNTRL, JTIME, JLIMIT, JROLL 

TRIG  FUNCTIONS  FOR  DEGREES 

SIN  DG<X)  *  DSIN<DG  TO  RD  X  X> 

COS  DG(X)  -  DCOS<  DG  TO  RO  X  X> 

I F  <  JOB . EQ . 1 >  GOTO  1 

USOUNO  AT  10,000 

USOUND  -  437.43 
K  TO  FT  -  1.48894 
DG  TO  RD  «  .0174532929 
RD  TO  DG  «  57.29577951 


Initial  Conditions 


ALTID0 
GMB  TH0 
GM8  PS0 
RNG0 
TRG  V0 
ASP  TH0 
ASP  PS0 
MISS  DS 
HIT 


10000.0 
.  107 
*  40.0 
3500.0 
0.9 
0.0 
180.0 
20. 

.FALSE. 


Targot  Manuovor 


OOO  OOCJ  u  u  u  uoo 
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TRG  PHI  -  -90. 

JMAN  *  0 

MISSILE 

MSL  V0  -  0.9 
THET0  -0.0 
PHI 0  -  0.0 

PSI0  -  0.0 

INERTIAL  TO  BODY  DIRECTION  COSINES 

Dll  «  DCOS<THET0) XDCOS< PSI 0> 

D 12  »  DCOS<THET0>  XDSIN<PSI0) 

D13  »  -  DSIN<THET0> 

D21  -  DSIN< PHI 0) XDSIN<THET0) XDCOS< PSI 0)  - 
1  DCOS<  PHI 0> XDSIN<  PSI0) 

D22  ■  DSIN(PHI0>  XDSIN<THET0)  XDSIN(PSI0)  + 

1  DCOS<  PHI  0) XDCOS( PSI 0) 

D23  -  DSIN< PHI 0) XDCOS<THET0) 

D31  -  DCOS( PHI  0) XDSIN(THET0)  XDCOS<  PSI 0>  + 

1  DSIN(PHI0>  XDSIN<PSI0) 

D32  -  DCOS< PHIS)  XDSIN(THET0) XDSIN(PSI 0)  - 
1  DSINCPHI0) XDCOS(PSIO) 

D33  -  DCOS ( PH 1 0  >  X  DCOS ( THET0 ) 

Y<  1)  -  0. 

Y<  2)  •  0. 

Y<3)  -  -ALTID0 

Y<4)  -  MSL  V0  X  VSOUND  X  K  TO  FT 

Y<3)  «  0. 

Y<6)  «  0. 

Y< 7)  -  0. 

Y<8)  »  PHI  0 

Y<9)  ■  THET0 

Y< 10>  *  PSI 0 

Y(ll)  -  0. 

Y<  12)  »  0. 

Y<  13)  »  0. 

Y< 14)  ■  GMB  TH0XDG  TO  RD 

Y< 13)  -  GMB  PS0XDG  TO  RD 

SEEKER  ANGLES  <BODY  TO  SEEKER) 

SEEK  11  «  COS  DG(GMB  TH0)  X  COS  DG<GMB  PS0) 
SEEK  12  ■  COS  DG<GMB  TH0)  X  SIN  DG(GMB  PS0) 
SEEK  13  —  SIN  DG(GMB  TH0> 

SEEK  21  —  SIN  DG(GMB  PS0) 


SEEK  22  =  COS  DG< GMB  PS0> 

SEEK  23  a  0 . 

SEEK  31  «  SIN  DG< GMB  TH0>  *  COS  DG< GMB  PS0) 

SEEK  32  ■  SIN  DG< GMB  TH0)  X  SIN  DG< GMB  PS0) 

SEEK  33  »  COS  OG<GMB  TH0) 

OLOSQ  *  0. 

DLOSR  -  0. 

TIME  TO  GO 

TGO  HT  »  2.520 

MISSILE  CONTROL  INPUTS 

U<  1)  *  0. 

U( 2)  *  0. 

U<3)  »  0. 

U< 4)  »  0. 

TARGET  <BODY  TO  INERTIAL) 

TRG  XI  -  RNG0 X < D 1 1 X SEEK  1 1  ♦  D21XSEEK 12  +  D31XSEEK13) 

TRG  YI  »  RNG0X ( D 12XSEEK 1 1  ♦  D22XSEEK 12  +  032XSEEK 13) 

TRG  21  *  RNG0 X < D 1 3X SEEK  1 1  ♦  D23XSEEK12  +  D33XSEEK 13) 

-  ALT I 00 

TRG  XI 0  -  TRG  XI 

TRG  YI 0  -  TRG  YI 

TRG  210  ■  TRG  21 

TRG  AXI  -  0.0 
TRG  AYI  -  0.0 
TRG  A2I  -  0.0 

TRG  VXS  »  TRG  V0XCOS  DG<ASP  TH0>  X  COS  DG<ASP  PS0) 

TRG  VYS  ■  TRG  V0XCOS  DG<ASP  TH0>  X  SIN  DGCASP  PS0) 

TRG  U2S  -  TRG  V0XSIN  DG<ASP  TH0) 

TRG  VXB  »  TRG  VXSXSEEK 1 1+TRG  VYSXSEEK2 1+TRG  V2SXSEEK31 

TRG  VYB  ■  TRG  UXSXSEEK 12+TRG  VYSXSEEK22 

TRG  V2B  -  TRG  VXSXSEEK13+TRG  VYSXSEEK23+TRG  V2SXSEEK33 

TRG  VXI  ■  D11XTRG  VXB+D21XTRG  VYB+D31XTRG  V2B 
TRG  VYI  ■  012XTRG  VXB+D22XTRG  VYB+D32XTRG  V2B 
TRG  V2I  ■  013XTRG  VXB+D23XTRG  VYB+D33XTRG  V2B 

COWERT  TO  FT/SEC 

TRG  VXI  -  TRG  VXI  X  VSOUND  X  K  TO  FT 


TRG  VYI  -  TRG  VYI  *  VSOUND  X  K  TO  FT 

TRG  VZI  =  TRG  VZI  *  VSOUND  X  K  TO  FT 

TRG  V0  *  TRG  V0  X  VSOUND  X  K  TO  FT 

INITIALIZE  RANGE  AND  VC 

RNG  I  =  RNG0 

VC  *  <TRG  VXI  -  Y<4)>  X  DABS<TRG  XI) 

1  +TRG  VYI  X  DABS<TRG  YI) 

2  +TRG  VZI  X  DABS < TRG  ZI) 

VC  »  VC/ RNG  I 

INITIALIZE  TARGET  MOTION 

IF<TRG  VYI.EQ.0)  TRG  PS0  =  10XX3 
IF<TRG  VYI.NE.0)  TRG  PS0  -  TRG  VXI/TRG  VYI 
TRG  PS0  -  DATAN<TRG  PS0)XRD  TO  DG 
IF<TRG  VXI .GE.0 .AND.TRG  VYI.GE.0.) 

1  TRG  PS0  ■  TRG  PS0 

IF<TRG  VXI .GE.0 .AND.TRG  VYI.LE.0.) 

1  TRG  PS0  »  -  TRG  PS0 

I F<TRG  VXI .LE.0 .AND.TRG  VYI.GE.0.) 

1  TRG  PS0  ■  ♦  TRG  PS0  ♦  90. 

IFCTRG  VXI .LE.0 .AND.TRG  VYI.LE.0.) 

1  TRG  PS0  »  -  TRG  PS0  -  90. 

TH0  «  DSQRT<  <TRG  VXIXX2)+<TRG  VYIXX2) > 
IF<TH0 .EQ.0)  TRG  TH0  -  10XX3 
IF<TH0 .NE.0)  TRG  TH0  -  TRG  VZI/TH0 
TRG  TH0  ■  DATAN<TRG  TH0>  XRD  TO  DG 
IF<TRG  VZ I .GE.0.)  TRG  TH0  «  -  TRG  TH0 

CSPSI0  -  COS  DG<TRG  PS0> 

SNPSI0  -  SIN  DG<TRG  PS0) 

SNTH0  -  SIN  DG<TH0> 

TXO  -  TRG  XI 
TYO  -  TRG  YI 
TZO  -  TRG  ZI 
OLD  T  -0.0 

RETURN 

OUTPUT 

1  CONTINUE 

TRG  ALT  -  -TRG  ZI 
TRG  PH0  -  0. 

PHIm  -  Y(8)XRD  TODG 
THETAm  -  Y<  9) XRD  TO  DG 
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PSIm  «  Y< 10) XRD  TO  DG 
WRITE<NPLOT, 100) 

100  FORMAT < 1H1 ,////lX, 13< 'X') , '  Bank-to-Turn  Missile  ', 
l'Simul ation  ' , 12< '*') ,//) 

WRITE<NPLOT,200>  ALT 1 00 ,MSL  U0 ,THETAm,PHIm, 

1GMB  TH0 ,6MB  PS0 ,ASP  TH0,ASP  PS0  fTRG  ALT,TRG  V0 , 

2TRG  TH0 ,TR6  PH0 , RNG0 

PflBMfiTflY  G.f  lln'  /// 


515x,'Asp  Theta-' ,612.2, 4X, 'i 

615x,'Al  titude  »  '  ,612. 2, 5X,  _ _ ,  , _ , 

715X, 'Pitch  *  7 ,G12.2,3X,'Rol 1  -',612.2,//, 

81SX, 'Rang*  «  ',G12.2,/> 

WRITE<NPLOT,300)  Y<4) ,Y<5> ,Y<6> ,TRG  XI ,TRG  YI ,TR6  21 , 
1TRG  VXI,TRG  VYI ,TRG  VZI 

FORMAT < 1H0 , ' Ini tal  Posi t  ion/Ve  1 oci t y' ,//, 

15X, 'Missi 1 e  :'//, 13x,'X  Velocity  -  '.G12.2,/, 

215X,'Y  Velocity  ,612.2,/, 15X, '2  Vel oci ty  , 

3612.2,//, 

45X, 'Target  s'//,13x,'X  -  ',612.2,/, 


15X, 'Missi 1 e  :'//, 13x,'X  Veloci ty  -  '.G12.2 
215X,'Y  Velocity  -' ,612.2,/, 13X, '2  Velocity 

3612.2,//, 

43X, 'Target  s'//,13x,'X  -  ',612.2,/, 

313X,'Y  -  ' ,612.2,/, 15X,'Z  -  ',612.2,// 

6 13x,'X  Velocity  -  ',G12.2,/, 

715X,'Y  Velocity  -  '  ,612.2,/,  13X,'2  Velocit; 
8612.2) 

WRITE<NPL0T ,400)  MISS  0S.T60  HT,TR6  PHI 
400  FORMAT < 1H0 , 'Parameters  ',//, 

15X, 'Mia*  Distance  -  ',612.2, 

23X, 'TGO  HT  -  ',612.2,/, 

33X, 'Target  Roll  -  ' ,612.2) 

I F < JCNTRL . EQ . 1)  WRITE<NPLOT,300> 

300  F0RMAT( 1H0,'61  Guidance') 

IF< JCNTRL.EQ.2)  WRITE<NPLOT,310> 

310  FORMAT < lH0,'Pro-Nav  Guidance') 

I F< JCNTRL. EQ.3)  HRITECNPLOT ,520) 

320  F0RMAT< 1H0, 'Bank-to-Turn  Guidance') 

IFC JLIMIT .EQ.0)  WRITE<NPLOT ,330) 

530  F0RMAT< 1H0,' Unconstrained') 

IF< JLIMIT. EQ.l)  NRITE<NPLOT ,340) 

340  F0RMAT< 1H0,' Constrained') 

IF< JTIME.EQ. 1)  WRITE<NPLOT ,330) 

330  F0RMAT< 1H0,' Riggs  Tgo') 

I F< JTIME.EQ. 2)  WRITE<NPLOT,560> 

340  FORMAT ( 1H0 , 'New  Tgo') 


RETURN 

END 


APPENDIX  D 

GENERIC  MISSILE  CHARACTERISTICS 


The  generic  bank-to-turn  missile  (Figure  D.l)  is  a  short  range 
missile  that  can  produce  more  than  100  g  of  normal  acceleration  and 
approximately  5  g  of  lateral  acceleration.  ROLL  rates  of  up  to  500 
degrees  per  second  are  attainable.  Launch  weight  is  165  pounds  with  50 
pounds  of  propellant  that  produces  4712  pounds  of  thrust  for  2.6 
seconds.  The  shape  is  2:1  elliptical  cross  section  with  a  blunt  base 
and  parabolic  forebody.  The  wings  are  planar  with  a  clipped  double 
delta  platform.  The  tails  are  all  movable  crusiform  also  with  a  clipped 
double  delta.  Additional  information  is  available  in  [30,31]. 


Launch  CG  at 
FS  36.66 


FS  58.5 


V 


Dimensions  in  Inches 


Figure  D.l  BANK-TO-TURN  MISSILE 
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